ASoC: IMote2 ASoC Support
[linux-2.6] / drivers / md / bitmap.c
1 /*
2  * bitmap.c two-level bitmap (C) Peter T. Breuer (ptb@ot.uc3m.es) 2003
3  *
4  * bitmap_create  - sets up the bitmap structure
5  * bitmap_destroy - destroys the bitmap structure
6  *
7  * additions, Copyright (C) 2003-2004, Paul Clements, SteelEye Technology, Inc.:
8  * - added disk storage for bitmap
9  * - changes to allow various bitmap chunk sizes
10  */
11
12 /*
13  * Still to do:
14  *
15  * flush after percent set rather than just time based. (maybe both).
16  * wait if count gets too high, wake when it drops to half.
17  */
18
19 #include <linux/blkdev.h>
20 #include <linux/module.h>
21 #include <linux/errno.h>
22 #include <linux/slab.h>
23 #include <linux/init.h>
24 #include <linux/timer.h>
25 #include <linux/sched.h>
26 #include <linux/list.h>
27 #include <linux/file.h>
28 #include <linux/mount.h>
29 #include <linux/buffer_head.h>
30 #include "md.h"
31 #include "bitmap.h"
32
33 /* debug macros */
34
35 #define DEBUG 0
36
37 #if DEBUG
38 /* these are for debugging purposes only! */
39
40 /* define one and only one of these */
41 #define INJECT_FAULTS_1 0 /* cause bitmap_alloc_page to fail always */
42 #define INJECT_FAULTS_2 0 /* cause bitmap file to be kicked when first bit set*/
43 #define INJECT_FAULTS_3 0 /* treat bitmap file as kicked at init time */
44 #define INJECT_FAULTS_4 0 /* undef */
45 #define INJECT_FAULTS_5 0 /* undef */
46 #define INJECT_FAULTS_6 0
47
48 /* if these are defined, the driver will fail! debug only */
49 #define INJECT_FATAL_FAULT_1 0 /* fail kmalloc, causing bitmap_create to fail */
50 #define INJECT_FATAL_FAULT_2 0 /* undef */
51 #define INJECT_FATAL_FAULT_3 0 /* undef */
52 #endif
53
54 //#define DPRINTK PRINTK /* set this NULL to avoid verbose debug output */
55 #define DPRINTK(x...) do { } while(0)
56
57 #ifndef PRINTK
58 #  if DEBUG > 0
59 #    define PRINTK(x...) printk(KERN_DEBUG x)
60 #  else
61 #    define PRINTK(x...)
62 #  endif
63 #endif
64
65 static inline char * bmname(struct bitmap *bitmap)
66 {
67         return bitmap->mddev ? mdname(bitmap->mddev) : "mdX";
68 }
69
70
71 /*
72  * just a placeholder - calls kmalloc for bitmap pages
73  */
74 static unsigned char *bitmap_alloc_page(struct bitmap *bitmap)
75 {
76         unsigned char *page;
77
78 #ifdef INJECT_FAULTS_1
79         page = NULL;
80 #else
81         page = kmalloc(PAGE_SIZE, GFP_NOIO);
82 #endif
83         if (!page)
84                 printk("%s: bitmap_alloc_page FAILED\n", bmname(bitmap));
85         else
86                 PRINTK("%s: bitmap_alloc_page: allocated page at %p\n",
87                         bmname(bitmap), page);
88         return page;
89 }
90
91 /*
92  * for now just a placeholder -- just calls kfree for bitmap pages
93  */
94 static void bitmap_free_page(struct bitmap *bitmap, unsigned char *page)
95 {
96         PRINTK("%s: bitmap_free_page: free page %p\n", bmname(bitmap), page);
97         kfree(page);
98 }
99
100 /*
101  * check a page and, if necessary, allocate it (or hijack it if the alloc fails)
102  *
103  * 1) check to see if this page is allocated, if it's not then try to alloc
104  * 2) if the alloc fails, set the page's hijacked flag so we'll use the
105  *    page pointer directly as a counter
106  *
107  * if we find our page, we increment the page's refcount so that it stays
108  * allocated while we're using it
109  */
110 static int bitmap_checkpage(struct bitmap *bitmap, unsigned long page, int create)
111 {
112         unsigned char *mappage;
113
114         if (page >= bitmap->pages) {
115                 /* This can happen if bitmap_start_sync goes beyond
116                  * End-of-device while looking for a whole page.
117                  * It is harmless.
118                  */
119                 return -EINVAL;
120         }
121
122
123         if (bitmap->bp[page].hijacked) /* it's hijacked, don't try to alloc */
124                 return 0;
125
126         if (bitmap->bp[page].map) /* page is already allocated, just return */
127                 return 0;
128
129         if (!create)
130                 return -ENOENT;
131
132         spin_unlock_irq(&bitmap->lock);
133
134         /* this page has not been allocated yet */
135
136         if ((mappage = bitmap_alloc_page(bitmap)) == NULL) {
137                 PRINTK("%s: bitmap map page allocation failed, hijacking\n",
138                         bmname(bitmap));
139                 /* failed - set the hijacked flag so that we can use the
140                  * pointer as a counter */
141                 spin_lock_irq(&bitmap->lock);
142                 if (!bitmap->bp[page].map)
143                         bitmap->bp[page].hijacked = 1;
144                 goto out;
145         }
146
147         /* got a page */
148
149         spin_lock_irq(&bitmap->lock);
150
151         /* recheck the page */
152
153         if (bitmap->bp[page].map || bitmap->bp[page].hijacked) {
154                 /* somebody beat us to getting the page */
155                 bitmap_free_page(bitmap, mappage);
156                 return 0;
157         }
158
159         /* no page was in place and we have one, so install it */
160
161         memset(mappage, 0, PAGE_SIZE);
162         bitmap->bp[page].map = mappage;
163         bitmap->missing_pages--;
164 out:
165         return 0;
166 }
167
168
169 /* if page is completely empty, put it back on the free list, or dealloc it */
170 /* if page was hijacked, unmark the flag so it might get alloced next time */
171 /* Note: lock should be held when calling this */
172 static void bitmap_checkfree(struct bitmap *bitmap, unsigned long page)
173 {
174         char *ptr;
175
176         if (bitmap->bp[page].count) /* page is still busy */
177                 return;
178
179         /* page is no longer in use, it can be released */
180
181         if (bitmap->bp[page].hijacked) { /* page was hijacked, undo this now */
182                 bitmap->bp[page].hijacked = 0;
183                 bitmap->bp[page].map = NULL;
184                 return;
185         }
186
187         /* normal case, free the page */
188
189 #if 0
190 /* actually ... let's not.  We will probably need the page again exactly when
191  * memory is tight and we are flusing to disk
192  */
193         return;
194 #else
195         ptr = bitmap->bp[page].map;
196         bitmap->bp[page].map = NULL;
197         bitmap->missing_pages++;
198         bitmap_free_page(bitmap, ptr);
199         return;
200 #endif
201 }
202
203
204 /*
205  * bitmap file handling - read and write the bitmap file and its superblock
206  */
207
208 /*
209  * basic page I/O operations
210  */
211
212 /* IO operations when bitmap is stored near all superblocks */
213 static struct page *read_sb_page(mddev_t *mddev, long offset,
214                                  struct page *page,
215                                  unsigned long index, int size)
216 {
217         /* choose a good rdev and read the page from there */
218
219         mdk_rdev_t *rdev;
220         sector_t target;
221
222         if (!page)
223                 page = alloc_page(GFP_KERNEL);
224         if (!page)
225                 return ERR_PTR(-ENOMEM);
226
227         list_for_each_entry(rdev, &mddev->disks, same_set) {
228                 if (! test_bit(In_sync, &rdev->flags)
229                     || test_bit(Faulty, &rdev->flags))
230                         continue;
231
232                 target = rdev->sb_start + offset + index * (PAGE_SIZE/512);
233
234                 if (sync_page_io(rdev->bdev, target,
235                                  roundup(size, bdev_hardsect_size(rdev->bdev)),
236                                  page, READ)) {
237                         page->index = index;
238                         attach_page_buffers(page, NULL); /* so that free_buffer will
239                                                           * quietly no-op */
240                         return page;
241                 }
242         }
243         return ERR_PTR(-EIO);
244
245 }
246
247 static mdk_rdev_t *next_active_rdev(mdk_rdev_t *rdev, mddev_t *mddev)
248 {
249         /* Iterate the disks of an mddev, using rcu to protect access to the
250          * linked list, and raising the refcount of devices we return to ensure
251          * they don't disappear while in use.
252          * As devices are only added or removed when raid_disk is < 0 and
253          * nr_pending is 0 and In_sync is clear, the entries we return will
254          * still be in the same position on the list when we re-enter
255          * list_for_each_continue_rcu.
256          */
257         struct list_head *pos;
258         rcu_read_lock();
259         if (rdev == NULL)
260                 /* start at the beginning */
261                 pos = &mddev->disks;
262         else {
263                 /* release the previous rdev and start from there. */
264                 rdev_dec_pending(rdev, mddev);
265                 pos = &rdev->same_set;
266         }
267         list_for_each_continue_rcu(pos, &mddev->disks) {
268                 rdev = list_entry(pos, mdk_rdev_t, same_set);
269                 if (rdev->raid_disk >= 0 &&
270                     !test_bit(Faulty, &rdev->flags)) {
271                         /* this is a usable devices */
272                         atomic_inc(&rdev->nr_pending);
273                         rcu_read_unlock();
274                         return rdev;
275                 }
276         }
277         rcu_read_unlock();
278         return NULL;
279 }
280
281 static int write_sb_page(struct bitmap *bitmap, struct page *page, int wait)
282 {
283         mdk_rdev_t *rdev = NULL;
284         mddev_t *mddev = bitmap->mddev;
285
286         while ((rdev = next_active_rdev(rdev, mddev)) != NULL) {
287                         int size = PAGE_SIZE;
288                         if (page->index == bitmap->file_pages-1)
289                                 size = roundup(bitmap->last_page_size,
290                                                bdev_hardsect_size(rdev->bdev));
291                         /* Just make sure we aren't corrupting data or
292                          * metadata
293                          */
294                         if (bitmap->offset < 0) {
295                                 /* DATA  BITMAP METADATA  */
296                                 if (bitmap->offset
297                                     + (long)(page->index * (PAGE_SIZE/512))
298                                     + size/512 > 0)
299                                         /* bitmap runs in to metadata */
300                                         goto bad_alignment;
301                                 if (rdev->data_offset + mddev->dev_sectors
302                                     > rdev->sb_start + bitmap->offset)
303                                         /* data runs in to bitmap */
304                                         goto bad_alignment;
305                         } else if (rdev->sb_start < rdev->data_offset) {
306                                 /* METADATA BITMAP DATA */
307                                 if (rdev->sb_start
308                                     + bitmap->offset
309                                     + page->index*(PAGE_SIZE/512) + size/512
310                                     > rdev->data_offset)
311                                         /* bitmap runs in to data */
312                                         goto bad_alignment;
313                         } else {
314                                 /* DATA METADATA BITMAP - no problems */
315                         }
316                         md_super_write(mddev, rdev,
317                                        rdev->sb_start + bitmap->offset
318                                        + page->index * (PAGE_SIZE/512),
319                                        size,
320                                        page);
321         }
322
323         if (wait)
324                 md_super_wait(mddev);
325         return 0;
326
327  bad_alignment:
328         rcu_read_unlock();
329         return -EINVAL;
330 }
331
332 static void bitmap_file_kick(struct bitmap *bitmap);
333 /*
334  * write out a page to a file
335  */
336 static void write_page(struct bitmap *bitmap, struct page *page, int wait)
337 {
338         struct buffer_head *bh;
339
340         if (bitmap->file == NULL) {
341                 switch (write_sb_page(bitmap, page, wait)) {
342                 case -EINVAL:
343                         bitmap->flags |= BITMAP_WRITE_ERROR;
344                 }
345         } else {
346
347                 bh = page_buffers(page);
348
349                 while (bh && bh->b_blocknr) {
350                         atomic_inc(&bitmap->pending_writes);
351                         set_buffer_locked(bh);
352                         set_buffer_mapped(bh);
353                         submit_bh(WRITE, bh);
354                         bh = bh->b_this_page;
355                 }
356
357                 if (wait) {
358                         wait_event(bitmap->write_wait,
359                                    atomic_read(&bitmap->pending_writes)==0);
360                 }
361         }
362         if (bitmap->flags & BITMAP_WRITE_ERROR)
363                 bitmap_file_kick(bitmap);
364 }
365
366 static void end_bitmap_write(struct buffer_head *bh, int uptodate)
367 {
368         struct bitmap *bitmap = bh->b_private;
369         unsigned long flags;
370
371         if (!uptodate) {
372                 spin_lock_irqsave(&bitmap->lock, flags);
373                 bitmap->flags |= BITMAP_WRITE_ERROR;
374                 spin_unlock_irqrestore(&bitmap->lock, flags);
375         }
376         if (atomic_dec_and_test(&bitmap->pending_writes))
377                 wake_up(&bitmap->write_wait);
378 }
379
380 /* copied from buffer.c */
381 static void
382 __clear_page_buffers(struct page *page)
383 {
384         ClearPagePrivate(page);
385         set_page_private(page, 0);
386         page_cache_release(page);
387 }
388 static void free_buffers(struct page *page)
389 {
390         struct buffer_head *bh = page_buffers(page);
391
392         while (bh) {
393                 struct buffer_head *next = bh->b_this_page;
394                 free_buffer_head(bh);
395                 bh = next;
396         }
397         __clear_page_buffers(page);
398         put_page(page);
399 }
400
401 /* read a page from a file.
402  * We both read the page, and attach buffers to the page to record the
403  * address of each block (using bmap).  These addresses will be used
404  * to write the block later, completely bypassing the filesystem.
405  * This usage is similar to how swap files are handled, and allows us
406  * to write to a file with no concerns of memory allocation failing.
407  */
408 static struct page *read_page(struct file *file, unsigned long index,
409                               struct bitmap *bitmap,
410                               unsigned long count)
411 {
412         struct page *page = NULL;
413         struct inode *inode = file->f_path.dentry->d_inode;
414         struct buffer_head *bh;
415         sector_t block;
416
417         PRINTK("read bitmap file (%dB @ %Lu)\n", (int)PAGE_SIZE,
418                         (unsigned long long)index << PAGE_SHIFT);
419
420         page = alloc_page(GFP_KERNEL);
421         if (!page)
422                 page = ERR_PTR(-ENOMEM);
423         if (IS_ERR(page))
424                 goto out;
425
426         bh = alloc_page_buffers(page, 1<<inode->i_blkbits, 0);
427         if (!bh) {
428                 put_page(page);
429                 page = ERR_PTR(-ENOMEM);
430                 goto out;
431         }
432         attach_page_buffers(page, bh);
433         block = index << (PAGE_SHIFT - inode->i_blkbits);
434         while (bh) {
435                 if (count == 0)
436                         bh->b_blocknr = 0;
437                 else {
438                         bh->b_blocknr = bmap(inode, block);
439                         if (bh->b_blocknr == 0) {
440                                 /* Cannot use this file! */
441                                 free_buffers(page);
442                                 page = ERR_PTR(-EINVAL);
443                                 goto out;
444                         }
445                         bh->b_bdev = inode->i_sb->s_bdev;
446                         if (count < (1<<inode->i_blkbits))
447                                 count = 0;
448                         else
449                                 count -= (1<<inode->i_blkbits);
450
451                         bh->b_end_io = end_bitmap_write;
452                         bh->b_private = bitmap;
453                         atomic_inc(&bitmap->pending_writes);
454                         set_buffer_locked(bh);
455                         set_buffer_mapped(bh);
456                         submit_bh(READ, bh);
457                 }
458                 block++;
459                 bh = bh->b_this_page;
460         }
461         page->index = index;
462
463         wait_event(bitmap->write_wait,
464                    atomic_read(&bitmap->pending_writes)==0);
465         if (bitmap->flags & BITMAP_WRITE_ERROR) {
466                 free_buffers(page);
467                 page = ERR_PTR(-EIO);
468         }
469 out:
470         if (IS_ERR(page))
471                 printk(KERN_ALERT "md: bitmap read error: (%dB @ %Lu): %ld\n",
472                         (int)PAGE_SIZE,
473                         (unsigned long long)index << PAGE_SHIFT,
474                         PTR_ERR(page));
475         return page;
476 }
477
478 /*
479  * bitmap file superblock operations
480  */
481
482 /* update the event counter and sync the superblock to disk */
483 void bitmap_update_sb(struct bitmap *bitmap)
484 {
485         bitmap_super_t *sb;
486         unsigned long flags;
487
488         if (!bitmap || !bitmap->mddev) /* no bitmap for this array */
489                 return;
490         spin_lock_irqsave(&bitmap->lock, flags);
491         if (!bitmap->sb_page) { /* no superblock */
492                 spin_unlock_irqrestore(&bitmap->lock, flags);
493                 return;
494         }
495         spin_unlock_irqrestore(&bitmap->lock, flags);
496         sb = (bitmap_super_t *)kmap_atomic(bitmap->sb_page, KM_USER0);
497         sb->events = cpu_to_le64(bitmap->mddev->events);
498         if (bitmap->mddev->events < bitmap->events_cleared) {
499                 /* rocking back to read-only */
500                 bitmap->events_cleared = bitmap->mddev->events;
501                 sb->events_cleared = cpu_to_le64(bitmap->events_cleared);
502         }
503         kunmap_atomic(sb, KM_USER0);
504         write_page(bitmap, bitmap->sb_page, 1);
505 }
506
507 /* print out the bitmap file superblock */
508 void bitmap_print_sb(struct bitmap *bitmap)
509 {
510         bitmap_super_t *sb;
511
512         if (!bitmap || !bitmap->sb_page)
513                 return;
514         sb = (bitmap_super_t *)kmap_atomic(bitmap->sb_page, KM_USER0);
515         printk(KERN_DEBUG "%s: bitmap file superblock:\n", bmname(bitmap));
516         printk(KERN_DEBUG "         magic: %08x\n", le32_to_cpu(sb->magic));
517         printk(KERN_DEBUG "       version: %d\n", le32_to_cpu(sb->version));
518         printk(KERN_DEBUG "          uuid: %08x.%08x.%08x.%08x\n",
519                                         *(__u32 *)(sb->uuid+0),
520                                         *(__u32 *)(sb->uuid+4),
521                                         *(__u32 *)(sb->uuid+8),
522                                         *(__u32 *)(sb->uuid+12));
523         printk(KERN_DEBUG "        events: %llu\n",
524                         (unsigned long long) le64_to_cpu(sb->events));
525         printk(KERN_DEBUG "events cleared: %llu\n",
526                         (unsigned long long) le64_to_cpu(sb->events_cleared));
527         printk(KERN_DEBUG "         state: %08x\n", le32_to_cpu(sb->state));
528         printk(KERN_DEBUG "     chunksize: %d B\n", le32_to_cpu(sb->chunksize));
529         printk(KERN_DEBUG "  daemon sleep: %ds\n", le32_to_cpu(sb->daemon_sleep));
530         printk(KERN_DEBUG "     sync size: %llu KB\n",
531                         (unsigned long long)le64_to_cpu(sb->sync_size)/2);
532         printk(KERN_DEBUG "max write behind: %d\n", le32_to_cpu(sb->write_behind));
533         kunmap_atomic(sb, KM_USER0);
534 }
535
536 /* read the superblock from the bitmap file and initialize some bitmap fields */
537 static int bitmap_read_sb(struct bitmap *bitmap)
538 {
539         char *reason = NULL;
540         bitmap_super_t *sb;
541         unsigned long chunksize, daemon_sleep, write_behind;
542         unsigned long long events;
543         int err = -EINVAL;
544
545         /* page 0 is the superblock, read it... */
546         if (bitmap->file) {
547                 loff_t isize = i_size_read(bitmap->file->f_mapping->host);
548                 int bytes = isize > PAGE_SIZE ? PAGE_SIZE : isize;
549
550                 bitmap->sb_page = read_page(bitmap->file, 0, bitmap, bytes);
551         } else {
552                 bitmap->sb_page = read_sb_page(bitmap->mddev, bitmap->offset,
553                                                NULL,
554                                                0, sizeof(bitmap_super_t));
555         }
556         if (IS_ERR(bitmap->sb_page)) {
557                 err = PTR_ERR(bitmap->sb_page);
558                 bitmap->sb_page = NULL;
559                 return err;
560         }
561
562         sb = (bitmap_super_t *)kmap_atomic(bitmap->sb_page, KM_USER0);
563
564         chunksize = le32_to_cpu(sb->chunksize);
565         daemon_sleep = le32_to_cpu(sb->daemon_sleep);
566         write_behind = le32_to_cpu(sb->write_behind);
567
568         /* verify that the bitmap-specific fields are valid */
569         if (sb->magic != cpu_to_le32(BITMAP_MAGIC))
570                 reason = "bad magic";
571         else if (le32_to_cpu(sb->version) < BITMAP_MAJOR_LO ||
572                  le32_to_cpu(sb->version) > BITMAP_MAJOR_HI)
573                 reason = "unrecognized superblock version";
574         else if (chunksize < 512)
575                 reason = "bitmap chunksize too small";
576         else if ((1 << ffz(~chunksize)) != chunksize)
577                 reason = "bitmap chunksize not a power of 2";
578         else if (daemon_sleep < 1 || daemon_sleep > MAX_SCHEDULE_TIMEOUT / HZ)
579                 reason = "daemon sleep period out of range";
580         else if (write_behind > COUNTER_MAX)
581                 reason = "write-behind limit out of range (0 - 16383)";
582         if (reason) {
583                 printk(KERN_INFO "%s: invalid bitmap file superblock: %s\n",
584                         bmname(bitmap), reason);
585                 goto out;
586         }
587
588         /* keep the array size field of the bitmap superblock up to date */
589         sb->sync_size = cpu_to_le64(bitmap->mddev->resync_max_sectors);
590
591         if (!bitmap->mddev->persistent)
592                 goto success;
593
594         /*
595          * if we have a persistent array superblock, compare the
596          * bitmap's UUID and event counter to the mddev's
597          */
598         if (memcmp(sb->uuid, bitmap->mddev->uuid, 16)) {
599                 printk(KERN_INFO "%s: bitmap superblock UUID mismatch\n",
600                         bmname(bitmap));
601                 goto out;
602         }
603         events = le64_to_cpu(sb->events);
604         if (events < bitmap->mddev->events) {
605                 printk(KERN_INFO "%s: bitmap file is out of date (%llu < %llu) "
606                         "-- forcing full recovery\n", bmname(bitmap), events,
607                         (unsigned long long) bitmap->mddev->events);
608                 sb->state |= cpu_to_le32(BITMAP_STALE);
609         }
610 success:
611         /* assign fields using values from superblock */
612         bitmap->chunksize = chunksize;
613         bitmap->daemon_sleep = daemon_sleep;
614         bitmap->daemon_lastrun = jiffies;
615         bitmap->max_write_behind = write_behind;
616         bitmap->flags |= le32_to_cpu(sb->state);
617         if (le32_to_cpu(sb->version) == BITMAP_MAJOR_HOSTENDIAN)
618                 bitmap->flags |= BITMAP_HOSTENDIAN;
619         bitmap->events_cleared = le64_to_cpu(sb->events_cleared);
620         if (sb->state & cpu_to_le32(BITMAP_STALE))
621                 bitmap->events_cleared = bitmap->mddev->events;
622         err = 0;
623 out:
624         kunmap_atomic(sb, KM_USER0);
625         if (err)
626                 bitmap_print_sb(bitmap);
627         return err;
628 }
629
630 enum bitmap_mask_op {
631         MASK_SET,
632         MASK_UNSET
633 };
634
635 /* record the state of the bitmap in the superblock.  Return the old value */
636 static int bitmap_mask_state(struct bitmap *bitmap, enum bitmap_state bits,
637                              enum bitmap_mask_op op)
638 {
639         bitmap_super_t *sb;
640         unsigned long flags;
641         int old;
642
643         spin_lock_irqsave(&bitmap->lock, flags);
644         if (!bitmap->sb_page) { /* can't set the state */
645                 spin_unlock_irqrestore(&bitmap->lock, flags);
646                 return 0;
647         }
648         spin_unlock_irqrestore(&bitmap->lock, flags);
649         sb = (bitmap_super_t *)kmap_atomic(bitmap->sb_page, KM_USER0);
650         old = le32_to_cpu(sb->state) & bits;
651         switch (op) {
652                 case MASK_SET: sb->state |= cpu_to_le32(bits);
653                                 break;
654                 case MASK_UNSET: sb->state &= cpu_to_le32(~bits);
655                                 break;
656                 default: BUG();
657         }
658         kunmap_atomic(sb, KM_USER0);
659         return old;
660 }
661
662 /*
663  * general bitmap file operations
664  */
665
666 /* calculate the index of the page that contains this bit */
667 static inline unsigned long file_page_index(unsigned long chunk)
668 {
669         return CHUNK_BIT_OFFSET(chunk) >> PAGE_BIT_SHIFT;
670 }
671
672 /* calculate the (bit) offset of this bit within a page */
673 static inline unsigned long file_page_offset(unsigned long chunk)
674 {
675         return CHUNK_BIT_OFFSET(chunk) & (PAGE_BITS - 1);
676 }
677
678 /*
679  * return a pointer to the page in the filemap that contains the given bit
680  *
681  * this lookup is complicated by the fact that the bitmap sb might be exactly
682  * 1 page (e.g., x86) or less than 1 page -- so the bitmap might start on page
683  * 0 or page 1
684  */
685 static inline struct page *filemap_get_page(struct bitmap *bitmap,
686                                         unsigned long chunk)
687 {
688         if (file_page_index(chunk) >= bitmap->file_pages) return NULL;
689         return bitmap->filemap[file_page_index(chunk) - file_page_index(0)];
690 }
691
692
693 static void bitmap_file_unmap(struct bitmap *bitmap)
694 {
695         struct page **map, *sb_page;
696         unsigned long *attr;
697         int pages;
698         unsigned long flags;
699
700         spin_lock_irqsave(&bitmap->lock, flags);
701         map = bitmap->filemap;
702         bitmap->filemap = NULL;
703         attr = bitmap->filemap_attr;
704         bitmap->filemap_attr = NULL;
705         pages = bitmap->file_pages;
706         bitmap->file_pages = 0;
707         sb_page = bitmap->sb_page;
708         bitmap->sb_page = NULL;
709         spin_unlock_irqrestore(&bitmap->lock, flags);
710
711         while (pages--)
712                 if (map[pages]->index != 0) /* 0 is sb_page, release it below */
713                         free_buffers(map[pages]);
714         kfree(map);
715         kfree(attr);
716
717         if (sb_page)
718                 free_buffers(sb_page);
719 }
720
721 static void bitmap_file_put(struct bitmap *bitmap)
722 {
723         struct file *file;
724         unsigned long flags;
725
726         spin_lock_irqsave(&bitmap->lock, flags);
727         file = bitmap->file;
728         bitmap->file = NULL;
729         spin_unlock_irqrestore(&bitmap->lock, flags);
730
731         if (file)
732                 wait_event(bitmap->write_wait,
733                            atomic_read(&bitmap->pending_writes)==0);
734         bitmap_file_unmap(bitmap);
735
736         if (file) {
737                 struct inode *inode = file->f_path.dentry->d_inode;
738                 invalidate_mapping_pages(inode->i_mapping, 0, -1);
739                 fput(file);
740         }
741 }
742
743
744 /*
745  * bitmap_file_kick - if an error occurs while manipulating the bitmap file
746  * then it is no longer reliable, so we stop using it and we mark the file
747  * as failed in the superblock
748  */
749 static void bitmap_file_kick(struct bitmap *bitmap)
750 {
751         char *path, *ptr = NULL;
752
753         if (bitmap_mask_state(bitmap, BITMAP_STALE, MASK_SET) == 0) {
754                 bitmap_update_sb(bitmap);
755
756                 if (bitmap->file) {
757                         path = kmalloc(PAGE_SIZE, GFP_KERNEL);
758                         if (path)
759                                 ptr = d_path(&bitmap->file->f_path, path,
760                                              PAGE_SIZE);
761
762
763                         printk(KERN_ALERT
764                               "%s: kicking failed bitmap file %s from array!\n",
765                               bmname(bitmap), IS_ERR(ptr) ? "" : ptr);
766
767                         kfree(path);
768                 } else
769                         printk(KERN_ALERT
770                                "%s: disabling internal bitmap due to errors\n",
771                                bmname(bitmap));
772         }
773
774         bitmap_file_put(bitmap);
775
776         return;
777 }
778
779 enum bitmap_page_attr {
780         BITMAP_PAGE_DIRTY = 0, // there are set bits that need to be synced
781         BITMAP_PAGE_CLEAN = 1, // there are bits that might need to be cleared
782         BITMAP_PAGE_NEEDWRITE=2, // there are cleared bits that need to be synced
783 };
784
785 static inline void set_page_attr(struct bitmap *bitmap, struct page *page,
786                                 enum bitmap_page_attr attr)
787 {
788         __set_bit((page->index<<2) + attr, bitmap->filemap_attr);
789 }
790
791 static inline void clear_page_attr(struct bitmap *bitmap, struct page *page,
792                                 enum bitmap_page_attr attr)
793 {
794         __clear_bit((page->index<<2) + attr, bitmap->filemap_attr);
795 }
796
797 static inline unsigned long test_page_attr(struct bitmap *bitmap, struct page *page,
798                                            enum bitmap_page_attr attr)
799 {
800         return test_bit((page->index<<2) + attr, bitmap->filemap_attr);
801 }
802
803 /*
804  * bitmap_file_set_bit -- called before performing a write to the md device
805  * to set (and eventually sync) a particular bit in the bitmap file
806  *
807  * we set the bit immediately, then we record the page number so that
808  * when an unplug occurs, we can flush the dirty pages out to disk
809  */
810 static void bitmap_file_set_bit(struct bitmap *bitmap, sector_t block)
811 {
812         unsigned long bit;
813         struct page *page;
814         void *kaddr;
815         unsigned long chunk = block >> CHUNK_BLOCK_SHIFT(bitmap);
816
817         if (!bitmap->filemap) {
818                 return;
819         }
820
821         page = filemap_get_page(bitmap, chunk);
822         if (!page) return;
823         bit = file_page_offset(chunk);
824
825         /* set the bit */
826         kaddr = kmap_atomic(page, KM_USER0);
827         if (bitmap->flags & BITMAP_HOSTENDIAN)
828                 set_bit(bit, kaddr);
829         else
830                 ext2_set_bit(bit, kaddr);
831         kunmap_atomic(kaddr, KM_USER0);
832         PRINTK("set file bit %lu page %lu\n", bit, page->index);
833
834         /* record page number so it gets flushed to disk when unplug occurs */
835         set_page_attr(bitmap, page, BITMAP_PAGE_DIRTY);
836
837 }
838
839 /* this gets called when the md device is ready to unplug its underlying
840  * (slave) device queues -- before we let any writes go down, we need to
841  * sync the dirty pages of the bitmap file to disk */
842 void bitmap_unplug(struct bitmap *bitmap)
843 {
844         unsigned long i, flags;
845         int dirty, need_write;
846         struct page *page;
847         int wait = 0;
848
849         if (!bitmap)
850                 return;
851
852         /* look at each page to see if there are any set bits that need to be
853          * flushed out to disk */
854         for (i = 0; i < bitmap->file_pages; i++) {
855                 spin_lock_irqsave(&bitmap->lock, flags);
856                 if (!bitmap->filemap) {
857                         spin_unlock_irqrestore(&bitmap->lock, flags);
858                         return;
859                 }
860                 page = bitmap->filemap[i];
861                 dirty = test_page_attr(bitmap, page, BITMAP_PAGE_DIRTY);
862                 need_write = test_page_attr(bitmap, page, BITMAP_PAGE_NEEDWRITE);
863                 clear_page_attr(bitmap, page, BITMAP_PAGE_DIRTY);
864                 clear_page_attr(bitmap, page, BITMAP_PAGE_NEEDWRITE);
865                 if (dirty)
866                         wait = 1;
867                 spin_unlock_irqrestore(&bitmap->lock, flags);
868
869                 if (dirty | need_write)
870                         write_page(bitmap, page, 0);
871         }
872         if (wait) { /* if any writes were performed, we need to wait on them */
873                 if (bitmap->file)
874                         wait_event(bitmap->write_wait,
875                                    atomic_read(&bitmap->pending_writes)==0);
876                 else
877                         md_super_wait(bitmap->mddev);
878         }
879         if (bitmap->flags & BITMAP_WRITE_ERROR)
880                 bitmap_file_kick(bitmap);
881 }
882
883 static void bitmap_set_memory_bits(struct bitmap *bitmap, sector_t offset, int needed);
884 /* * bitmap_init_from_disk -- called at bitmap_create time to initialize
885  * the in-memory bitmap from the on-disk bitmap -- also, sets up the
886  * memory mapping of the bitmap file
887  * Special cases:
888  *   if there's no bitmap file, or if the bitmap file had been
889  *   previously kicked from the array, we mark all the bits as
890  *   1's in order to cause a full resync.
891  *
892  * We ignore all bits for sectors that end earlier than 'start'.
893  * This is used when reading an out-of-date bitmap...
894  */
895 static int bitmap_init_from_disk(struct bitmap *bitmap, sector_t start)
896 {
897         unsigned long i, chunks, index, oldindex, bit;
898         struct page *page = NULL, *oldpage = NULL;
899         unsigned long num_pages, bit_cnt = 0;
900         struct file *file;
901         unsigned long bytes, offset;
902         int outofdate;
903         int ret = -ENOSPC;
904         void *paddr;
905
906         chunks = bitmap->chunks;
907         file = bitmap->file;
908
909         BUG_ON(!file && !bitmap->offset);
910
911 #ifdef INJECT_FAULTS_3
912         outofdate = 1;
913 #else
914         outofdate = bitmap->flags & BITMAP_STALE;
915 #endif
916         if (outofdate)
917                 printk(KERN_INFO "%s: bitmap file is out of date, doing full "
918                         "recovery\n", bmname(bitmap));
919
920         bytes = (chunks + 7) / 8;
921
922         num_pages = (bytes + sizeof(bitmap_super_t) + PAGE_SIZE - 1) / PAGE_SIZE;
923
924         if (file && i_size_read(file->f_mapping->host) < bytes + sizeof(bitmap_super_t)) {
925                 printk(KERN_INFO "%s: bitmap file too short %lu < %lu\n",
926                         bmname(bitmap),
927                         (unsigned long) i_size_read(file->f_mapping->host),
928                         bytes + sizeof(bitmap_super_t));
929                 goto err;
930         }
931
932         ret = -ENOMEM;
933
934         bitmap->filemap = kmalloc(sizeof(struct page *) * num_pages, GFP_KERNEL);
935         if (!bitmap->filemap)
936                 goto err;
937
938         /* We need 4 bits per page, rounded up to a multiple of sizeof(unsigned long) */
939         bitmap->filemap_attr = kzalloc(
940                 roundup( DIV_ROUND_UP(num_pages*4, 8), sizeof(unsigned long)),
941                 GFP_KERNEL);
942         if (!bitmap->filemap_attr)
943                 goto err;
944
945         oldindex = ~0L;
946
947         for (i = 0; i < chunks; i++) {
948                 int b;
949                 index = file_page_index(i);
950                 bit = file_page_offset(i);
951                 if (index != oldindex) { /* this is a new page, read it in */
952                         int count;
953                         /* unmap the old page, we're done with it */
954                         if (index == num_pages-1)
955                                 count = bytes + sizeof(bitmap_super_t)
956                                         - index * PAGE_SIZE;
957                         else
958                                 count = PAGE_SIZE;
959                         if (index == 0) {
960                                 /*
961                                  * if we're here then the superblock page
962                                  * contains some bits (PAGE_SIZE != sizeof sb)
963                                  * we've already read it in, so just use it
964                                  */
965                                 page = bitmap->sb_page;
966                                 offset = sizeof(bitmap_super_t);
967                                 if (!file)
968                                         read_sb_page(bitmap->mddev,
969                                                      bitmap->offset,
970                                                      page,
971                                                      index, count);
972                         } else if (file) {
973                                 page = read_page(file, index, bitmap, count);
974                                 offset = 0;
975                         } else {
976                                 page = read_sb_page(bitmap->mddev, bitmap->offset,
977                                                     NULL,
978                                                     index, count);
979                                 offset = 0;
980                         }
981                         if (IS_ERR(page)) { /* read error */
982                                 ret = PTR_ERR(page);
983                                 goto err;
984                         }
985
986                         oldindex = index;
987                         oldpage = page;
988
989                         if (outofdate) {
990                                 /*
991                                  * if bitmap is out of date, dirty the
992                                  * whole page and write it out
993                                  */
994                                 paddr = kmap_atomic(page, KM_USER0);
995                                 memset(paddr + offset, 0xff,
996                                        PAGE_SIZE - offset);
997                                 kunmap_atomic(paddr, KM_USER0);
998                                 write_page(bitmap, page, 1);
999
1000                                 ret = -EIO;
1001                                 if (bitmap->flags & BITMAP_WRITE_ERROR) {
1002                                         /* release, page not in filemap yet */
1003                                         put_page(page);
1004                                         goto err;
1005                                 }
1006                         }
1007
1008                         bitmap->filemap[bitmap->file_pages++] = page;
1009                         bitmap->last_page_size = count;
1010                 }
1011                 paddr = kmap_atomic(page, KM_USER0);
1012                 if (bitmap->flags & BITMAP_HOSTENDIAN)
1013                         b = test_bit(bit, paddr);
1014                 else
1015                         b = ext2_test_bit(bit, paddr);
1016                 kunmap_atomic(paddr, KM_USER0);
1017                 if (b) {
1018                         /* if the disk bit is set, set the memory bit */
1019                         bitmap_set_memory_bits(bitmap, i << CHUNK_BLOCK_SHIFT(bitmap),
1020                                                ((i+1) << (CHUNK_BLOCK_SHIFT(bitmap)) >= start)
1021                                 );
1022                         bit_cnt++;
1023                         set_page_attr(bitmap, page, BITMAP_PAGE_CLEAN);
1024                 }
1025         }
1026
1027         /* everything went OK */
1028         ret = 0;
1029         bitmap_mask_state(bitmap, BITMAP_STALE, MASK_UNSET);
1030
1031         if (bit_cnt) { /* Kick recovery if any bits were set */
1032                 set_bit(MD_RECOVERY_NEEDED, &bitmap->mddev->recovery);
1033                 md_wakeup_thread(bitmap->mddev->thread);
1034         }
1035
1036         printk(KERN_INFO "%s: bitmap initialized from disk: "
1037                 "read %lu/%lu pages, set %lu bits\n",
1038                 bmname(bitmap), bitmap->file_pages, num_pages, bit_cnt);
1039
1040         return 0;
1041
1042  err:
1043         printk(KERN_INFO "%s: bitmap initialisation failed: %d\n",
1044                bmname(bitmap), ret);
1045         return ret;
1046 }
1047
1048 void bitmap_write_all(struct bitmap *bitmap)
1049 {
1050         /* We don't actually write all bitmap blocks here,
1051          * just flag them as needing to be written
1052          */
1053         int i;
1054
1055         for (i=0; i < bitmap->file_pages; i++)
1056                 set_page_attr(bitmap, bitmap->filemap[i],
1057                               BITMAP_PAGE_NEEDWRITE);
1058 }
1059
1060
1061 static void bitmap_count_page(struct bitmap *bitmap, sector_t offset, int inc)
1062 {
1063         sector_t chunk = offset >> CHUNK_BLOCK_SHIFT(bitmap);
1064         unsigned long page = chunk >> PAGE_COUNTER_SHIFT;
1065         bitmap->bp[page].count += inc;
1066 /*
1067         if (page == 0) printk("count page 0, offset %llu: %d gives %d\n",
1068                               (unsigned long long)offset, inc, bitmap->bp[page].count);
1069 */
1070         bitmap_checkfree(bitmap, page);
1071 }
1072 static bitmap_counter_t *bitmap_get_counter(struct bitmap *bitmap,
1073                                             sector_t offset, int *blocks,
1074                                             int create);
1075
1076 /*
1077  * bitmap daemon -- periodically wakes up to clean bits and flush pages
1078  *                      out to disk
1079  */
1080
1081 void bitmap_daemon_work(struct bitmap *bitmap)
1082 {
1083         unsigned long j;
1084         unsigned long flags;
1085         struct page *page = NULL, *lastpage = NULL;
1086         int blocks;
1087         void *paddr;
1088
1089         if (bitmap == NULL)
1090                 return;
1091         if (time_before(jiffies, bitmap->daemon_lastrun + bitmap->daemon_sleep*HZ))
1092                 goto done;
1093
1094         bitmap->daemon_lastrun = jiffies;
1095         if (bitmap->allclean) {
1096                 bitmap->mddev->thread->timeout = MAX_SCHEDULE_TIMEOUT;
1097                 return;
1098         }
1099         bitmap->allclean = 1;
1100
1101         for (j = 0; j < bitmap->chunks; j++) {
1102                 bitmap_counter_t *bmc;
1103                 spin_lock_irqsave(&bitmap->lock, flags);
1104                 if (!bitmap->filemap) {
1105                         /* error or shutdown */
1106                         spin_unlock_irqrestore(&bitmap->lock, flags);
1107                         break;
1108                 }
1109
1110                 page = filemap_get_page(bitmap, j);
1111
1112                 if (page != lastpage) {
1113                         /* skip this page unless it's marked as needing cleaning */
1114                         if (!test_page_attr(bitmap, page, BITMAP_PAGE_CLEAN)) {
1115                                 int need_write = test_page_attr(bitmap, page,
1116                                                                 BITMAP_PAGE_NEEDWRITE);
1117                                 if (need_write)
1118                                         clear_page_attr(bitmap, page, BITMAP_PAGE_NEEDWRITE);
1119
1120                                 spin_unlock_irqrestore(&bitmap->lock, flags);
1121                                 if (need_write) {
1122                                         write_page(bitmap, page, 0);
1123                                         bitmap->allclean = 0;
1124                                 }
1125                                 continue;
1126                         }
1127
1128                         /* grab the new page, sync and release the old */
1129                         if (lastpage != NULL) {
1130                                 if (test_page_attr(bitmap, lastpage, BITMAP_PAGE_NEEDWRITE)) {
1131                                         clear_page_attr(bitmap, lastpage, BITMAP_PAGE_NEEDWRITE);
1132                                         spin_unlock_irqrestore(&bitmap->lock, flags);
1133                                         write_page(bitmap, lastpage, 0);
1134                                 } else {
1135                                         set_page_attr(bitmap, lastpage, BITMAP_PAGE_NEEDWRITE);
1136                                         spin_unlock_irqrestore(&bitmap->lock, flags);
1137                                 }
1138                         } else
1139                                 spin_unlock_irqrestore(&bitmap->lock, flags);
1140                         lastpage = page;
1141
1142                         /* We are possibly going to clear some bits, so make
1143                          * sure that events_cleared is up-to-date.
1144                          */
1145                         if (bitmap->need_sync) {
1146                                 bitmap_super_t *sb;
1147                                 bitmap->need_sync = 0;
1148                                 sb = kmap_atomic(bitmap->sb_page, KM_USER0);
1149                                 sb->events_cleared =
1150                                         cpu_to_le64(bitmap->events_cleared);
1151                                 kunmap_atomic(sb, KM_USER0);
1152                                 write_page(bitmap, bitmap->sb_page, 1);
1153                         }
1154                         spin_lock_irqsave(&bitmap->lock, flags);
1155                         clear_page_attr(bitmap, page, BITMAP_PAGE_CLEAN);
1156                 }
1157                 bmc = bitmap_get_counter(bitmap, j << CHUNK_BLOCK_SHIFT(bitmap),
1158                                         &blocks, 0);
1159                 if (bmc) {
1160 /*
1161   if (j < 100) printk("bitmap: j=%lu, *bmc = 0x%x\n", j, *bmc);
1162 */
1163                         if (*bmc)
1164                                 bitmap->allclean = 0;
1165
1166                         if (*bmc == 2) {
1167                                 *bmc=1; /* maybe clear the bit next time */
1168                                 set_page_attr(bitmap, page, BITMAP_PAGE_CLEAN);
1169                         } else if (*bmc == 1) {
1170                                 /* we can clear the bit */
1171                                 *bmc = 0;
1172                                 bitmap_count_page(bitmap, j << CHUNK_BLOCK_SHIFT(bitmap),
1173                                                   -1);
1174
1175                                 /* clear the bit */
1176                                 paddr = kmap_atomic(page, KM_USER0);
1177                                 if (bitmap->flags & BITMAP_HOSTENDIAN)
1178                                         clear_bit(file_page_offset(j), paddr);
1179                                 else
1180                                         ext2_clear_bit(file_page_offset(j), paddr);
1181                                 kunmap_atomic(paddr, KM_USER0);
1182                         }
1183                 }
1184                 spin_unlock_irqrestore(&bitmap->lock, flags);
1185         }
1186
1187         /* now sync the final page */
1188         if (lastpage != NULL) {
1189                 spin_lock_irqsave(&bitmap->lock, flags);
1190                 if (test_page_attr(bitmap, lastpage, BITMAP_PAGE_NEEDWRITE)) {
1191                         clear_page_attr(bitmap, lastpage, BITMAP_PAGE_NEEDWRITE);
1192                         spin_unlock_irqrestore(&bitmap->lock, flags);
1193                         write_page(bitmap, lastpage, 0);
1194                 } else {
1195                         set_page_attr(bitmap, lastpage, BITMAP_PAGE_NEEDWRITE);
1196                         spin_unlock_irqrestore(&bitmap->lock, flags);
1197                 }
1198         }
1199
1200  done:
1201         if (bitmap->allclean == 0)
1202                 bitmap->mddev->thread->timeout = bitmap->daemon_sleep * HZ;
1203 }
1204
1205 static bitmap_counter_t *bitmap_get_counter(struct bitmap *bitmap,
1206                                             sector_t offset, int *blocks,
1207                                             int create)
1208 {
1209         /* If 'create', we might release the lock and reclaim it.
1210          * The lock must have been taken with interrupts enabled.
1211          * If !create, we don't release the lock.
1212          */
1213         sector_t chunk = offset >> CHUNK_BLOCK_SHIFT(bitmap);
1214         unsigned long page = chunk >> PAGE_COUNTER_SHIFT;
1215         unsigned long pageoff = (chunk & PAGE_COUNTER_MASK) << COUNTER_BYTE_SHIFT;
1216         sector_t csize;
1217
1218         if (bitmap_checkpage(bitmap, page, create) < 0) {
1219                 csize = ((sector_t)1) << (CHUNK_BLOCK_SHIFT(bitmap));
1220                 *blocks = csize - (offset & (csize- 1));
1221                 return NULL;
1222         }
1223         /* now locked ... */
1224
1225         if (bitmap->bp[page].hijacked) { /* hijacked pointer */
1226                 /* should we use the first or second counter field
1227                  * of the hijacked pointer? */
1228                 int hi = (pageoff > PAGE_COUNTER_MASK);
1229                 csize = ((sector_t)1) << (CHUNK_BLOCK_SHIFT(bitmap) +
1230                                           PAGE_COUNTER_SHIFT - 1);
1231                 *blocks = csize - (offset & (csize- 1));
1232                 return  &((bitmap_counter_t *)
1233                           &bitmap->bp[page].map)[hi];
1234         } else { /* page is allocated */
1235                 csize = ((sector_t)1) << (CHUNK_BLOCK_SHIFT(bitmap));
1236                 *blocks = csize - (offset & (csize- 1));
1237                 return (bitmap_counter_t *)
1238                         &(bitmap->bp[page].map[pageoff]);
1239         }
1240 }
1241
1242 int bitmap_startwrite(struct bitmap *bitmap, sector_t offset, unsigned long sectors, int behind)
1243 {
1244         if (!bitmap) return 0;
1245
1246         if (behind) {
1247                 atomic_inc(&bitmap->behind_writes);
1248                 PRINTK(KERN_DEBUG "inc write-behind count %d/%d\n",
1249                   atomic_read(&bitmap->behind_writes), bitmap->max_write_behind);
1250         }
1251
1252         while (sectors) {
1253                 int blocks;
1254                 bitmap_counter_t *bmc;
1255
1256                 spin_lock_irq(&bitmap->lock);
1257                 bmc = bitmap_get_counter(bitmap, offset, &blocks, 1);
1258                 if (!bmc) {
1259                         spin_unlock_irq(&bitmap->lock);
1260                         return 0;
1261                 }
1262
1263                 if (unlikely((*bmc & COUNTER_MAX) == COUNTER_MAX)) {
1264                         DEFINE_WAIT(__wait);
1265                         /* note that it is safe to do the prepare_to_wait
1266                          * after the test as long as we do it before dropping
1267                          * the spinlock.
1268                          */
1269                         prepare_to_wait(&bitmap->overflow_wait, &__wait,
1270                                         TASK_UNINTERRUPTIBLE);
1271                         spin_unlock_irq(&bitmap->lock);
1272                         blk_unplug(bitmap->mddev->queue);
1273                         schedule();
1274                         finish_wait(&bitmap->overflow_wait, &__wait);
1275                         continue;
1276                 }
1277
1278                 switch(*bmc) {
1279                 case 0:
1280                         bitmap_file_set_bit(bitmap, offset);
1281                         bitmap_count_page(bitmap,offset, 1);
1282                         blk_plug_device_unlocked(bitmap->mddev->queue);
1283                         /* fall through */
1284                 case 1:
1285                         *bmc = 2;
1286                 }
1287
1288                 (*bmc)++;
1289
1290                 spin_unlock_irq(&bitmap->lock);
1291
1292                 offset += blocks;
1293                 if (sectors > blocks)
1294                         sectors -= blocks;
1295                 else sectors = 0;
1296         }
1297         bitmap->allclean = 0;
1298         return 0;
1299 }
1300
1301 void bitmap_endwrite(struct bitmap *bitmap, sector_t offset, unsigned long sectors,
1302                      int success, int behind)
1303 {
1304         if (!bitmap) return;
1305         if (behind) {
1306                 atomic_dec(&bitmap->behind_writes);
1307                 PRINTK(KERN_DEBUG "dec write-behind count %d/%d\n",
1308                   atomic_read(&bitmap->behind_writes), bitmap->max_write_behind);
1309         }
1310         if (bitmap->mddev->degraded)
1311                 /* Never clear bits or update events_cleared when degraded */
1312                 success = 0;
1313
1314         while (sectors) {
1315                 int blocks;
1316                 unsigned long flags;
1317                 bitmap_counter_t *bmc;
1318
1319                 spin_lock_irqsave(&bitmap->lock, flags);
1320                 bmc = bitmap_get_counter(bitmap, offset, &blocks, 0);
1321                 if (!bmc) {
1322                         spin_unlock_irqrestore(&bitmap->lock, flags);
1323                         return;
1324                 }
1325
1326                 if (success &&
1327                     bitmap->events_cleared < bitmap->mddev->events) {
1328                         bitmap->events_cleared = bitmap->mddev->events;
1329                         bitmap->need_sync = 1;
1330                 }
1331
1332                 if (!success && ! (*bmc & NEEDED_MASK))
1333                         *bmc |= NEEDED_MASK;
1334
1335                 if ((*bmc & COUNTER_MAX) == COUNTER_MAX)
1336                         wake_up(&bitmap->overflow_wait);
1337
1338                 (*bmc)--;
1339                 if (*bmc <= 2) {
1340                         set_page_attr(bitmap,
1341                                       filemap_get_page(bitmap, offset >> CHUNK_BLOCK_SHIFT(bitmap)),
1342                                       BITMAP_PAGE_CLEAN);
1343                 }
1344                 spin_unlock_irqrestore(&bitmap->lock, flags);
1345                 offset += blocks;
1346                 if (sectors > blocks)
1347                         sectors -= blocks;
1348                 else sectors = 0;
1349         }
1350 }
1351
1352 static int __bitmap_start_sync(struct bitmap *bitmap, sector_t offset, int *blocks,
1353                                int degraded)
1354 {
1355         bitmap_counter_t *bmc;
1356         int rv;
1357         if (bitmap == NULL) {/* FIXME or bitmap set as 'failed' */
1358                 *blocks = 1024;
1359                 return 1; /* always resync if no bitmap */
1360         }
1361         spin_lock_irq(&bitmap->lock);
1362         bmc = bitmap_get_counter(bitmap, offset, blocks, 0);
1363         rv = 0;
1364         if (bmc) {
1365                 /* locked */
1366                 if (RESYNC(*bmc))
1367                         rv = 1;
1368                 else if (NEEDED(*bmc)) {
1369                         rv = 1;
1370                         if (!degraded) { /* don't set/clear bits if degraded */
1371                                 *bmc |= RESYNC_MASK;
1372                                 *bmc &= ~NEEDED_MASK;
1373                         }
1374                 }
1375         }
1376         spin_unlock_irq(&bitmap->lock);
1377         bitmap->allclean = 0;
1378         return rv;
1379 }
1380
1381 int bitmap_start_sync(struct bitmap *bitmap, sector_t offset, int *blocks,
1382                       int degraded)
1383 {
1384         /* bitmap_start_sync must always report on multiples of whole
1385          * pages, otherwise resync (which is very PAGE_SIZE based) will
1386          * get confused.
1387          * So call __bitmap_start_sync repeatedly (if needed) until
1388          * At least PAGE_SIZE>>9 blocks are covered.
1389          * Return the 'or' of the result.
1390          */
1391         int rv = 0;
1392         int blocks1;
1393
1394         *blocks = 0;
1395         while (*blocks < (PAGE_SIZE>>9)) {
1396                 rv |= __bitmap_start_sync(bitmap, offset,
1397                                           &blocks1, degraded);
1398                 offset += blocks1;
1399                 *blocks += blocks1;
1400         }
1401         return rv;
1402 }
1403
1404 void bitmap_end_sync(struct bitmap *bitmap, sector_t offset, int *blocks, int aborted)
1405 {
1406         bitmap_counter_t *bmc;
1407         unsigned long flags;
1408 /*
1409         if (offset == 0) printk("bitmap_end_sync 0 (%d)\n", aborted);
1410 */      if (bitmap == NULL) {
1411                 *blocks = 1024;
1412                 return;
1413         }
1414         spin_lock_irqsave(&bitmap->lock, flags);
1415         bmc = bitmap_get_counter(bitmap, offset, blocks, 0);
1416         if (bmc == NULL)
1417                 goto unlock;
1418         /* locked */
1419 /*
1420         if (offset == 0) printk("bitmap_end sync found 0x%x, blocks %d\n", *bmc, *blocks);
1421 */
1422         if (RESYNC(*bmc)) {
1423                 *bmc &= ~RESYNC_MASK;
1424
1425                 if (!NEEDED(*bmc) && aborted)
1426                         *bmc |= NEEDED_MASK;
1427                 else {
1428                         if (*bmc <= 2) {
1429                                 set_page_attr(bitmap,
1430                                               filemap_get_page(bitmap, offset >> CHUNK_BLOCK_SHIFT(bitmap)),
1431                                               BITMAP_PAGE_CLEAN);
1432                         }
1433                 }
1434         }
1435  unlock:
1436         spin_unlock_irqrestore(&bitmap->lock, flags);
1437         bitmap->allclean = 0;
1438 }
1439
1440 void bitmap_close_sync(struct bitmap *bitmap)
1441 {
1442         /* Sync has finished, and any bitmap chunks that weren't synced
1443          * properly have been aborted.  It remains to us to clear the
1444          * RESYNC bit wherever it is still on
1445          */
1446         sector_t sector = 0;
1447         int blocks;
1448         if (!bitmap)
1449                 return;
1450         while (sector < bitmap->mddev->resync_max_sectors) {
1451                 bitmap_end_sync(bitmap, sector, &blocks, 0);
1452                 sector += blocks;
1453         }
1454 }
1455
1456 void bitmap_cond_end_sync(struct bitmap *bitmap, sector_t sector)
1457 {
1458         sector_t s = 0;
1459         int blocks;
1460
1461         if (!bitmap)
1462                 return;
1463         if (sector == 0) {
1464                 bitmap->last_end_sync = jiffies;
1465                 return;
1466         }
1467         if (time_before(jiffies, (bitmap->last_end_sync
1468                                   + bitmap->daemon_sleep * HZ)))
1469                 return;
1470         wait_event(bitmap->mddev->recovery_wait,
1471                    atomic_read(&bitmap->mddev->recovery_active) == 0);
1472
1473         bitmap->mddev->curr_resync_completed = bitmap->mddev->curr_resync;
1474         set_bit(MD_CHANGE_CLEAN, &bitmap->mddev->flags);
1475         sector &= ~((1ULL << CHUNK_BLOCK_SHIFT(bitmap)) - 1);
1476         s = 0;
1477         while (s < sector && s < bitmap->mddev->resync_max_sectors) {
1478                 bitmap_end_sync(bitmap, s, &blocks, 0);
1479                 s += blocks;
1480         }
1481         bitmap->last_end_sync = jiffies;
1482 }
1483
1484 static void bitmap_set_memory_bits(struct bitmap *bitmap, sector_t offset, int needed)
1485 {
1486         /* For each chunk covered by any of these sectors, set the
1487          * counter to 1 and set resync_needed.  They should all
1488          * be 0 at this point
1489          */
1490
1491         int secs;
1492         bitmap_counter_t *bmc;
1493         spin_lock_irq(&bitmap->lock);
1494         bmc = bitmap_get_counter(bitmap, offset, &secs, 1);
1495         if (!bmc) {
1496                 spin_unlock_irq(&bitmap->lock);
1497                 return;
1498         }
1499         if (! *bmc) {
1500                 struct page *page;
1501                 *bmc = 1 | (needed?NEEDED_MASK:0);
1502                 bitmap_count_page(bitmap, offset, 1);
1503                 page = filemap_get_page(bitmap, offset >> CHUNK_BLOCK_SHIFT(bitmap));
1504                 set_page_attr(bitmap, page, BITMAP_PAGE_CLEAN);
1505         }
1506         spin_unlock_irq(&bitmap->lock);
1507         bitmap->allclean = 0;
1508 }
1509
1510 /* dirty the memory and file bits for bitmap chunks "s" to "e" */
1511 void bitmap_dirty_bits(struct bitmap *bitmap, unsigned long s, unsigned long e)
1512 {
1513         unsigned long chunk;
1514
1515         for (chunk = s; chunk <= e; chunk++) {
1516                 sector_t sec = chunk << CHUNK_BLOCK_SHIFT(bitmap);
1517                 bitmap_set_memory_bits(bitmap, sec, 1);
1518                 bitmap_file_set_bit(bitmap, sec);
1519         }
1520 }
1521
1522 /*
1523  * flush out any pending updates
1524  */
1525 void bitmap_flush(mddev_t *mddev)
1526 {
1527         struct bitmap *bitmap = mddev->bitmap;
1528         int sleep;
1529
1530         if (!bitmap) /* there was no bitmap */
1531                 return;
1532
1533         /* run the daemon_work three time to ensure everything is flushed
1534          * that can be
1535          */
1536         sleep = bitmap->daemon_sleep;
1537         bitmap->daemon_sleep = 0;
1538         bitmap_daemon_work(bitmap);
1539         bitmap_daemon_work(bitmap);
1540         bitmap_daemon_work(bitmap);
1541         bitmap->daemon_sleep = sleep;
1542         bitmap_update_sb(bitmap);
1543 }
1544
1545 /*
1546  * free memory that was allocated
1547  */
1548 static void bitmap_free(struct bitmap *bitmap)
1549 {
1550         unsigned long k, pages;
1551         struct bitmap_page *bp;
1552
1553         if (!bitmap) /* there was no bitmap */
1554                 return;
1555
1556         /* release the bitmap file and kill the daemon */
1557         bitmap_file_put(bitmap);
1558
1559         bp = bitmap->bp;
1560         pages = bitmap->pages;
1561
1562         /* free all allocated memory */
1563
1564         if (bp) /* deallocate the page memory */
1565                 for (k = 0; k < pages; k++)
1566                         if (bp[k].map && !bp[k].hijacked)
1567                                 kfree(bp[k].map);
1568         kfree(bp);
1569         kfree(bitmap);
1570 }
1571 void bitmap_destroy(mddev_t *mddev)
1572 {
1573         struct bitmap *bitmap = mddev->bitmap;
1574
1575         if (!bitmap) /* there was no bitmap */
1576                 return;
1577
1578         mddev->bitmap = NULL; /* disconnect from the md device */
1579         if (mddev->thread)
1580                 mddev->thread->timeout = MAX_SCHEDULE_TIMEOUT;
1581
1582         bitmap_free(bitmap);
1583 }
1584
1585 /*
1586  * initialize the bitmap structure
1587  * if this returns an error, bitmap_destroy must be called to do clean up
1588  */
1589 int bitmap_create(mddev_t *mddev)
1590 {
1591         struct bitmap *bitmap;
1592         unsigned long blocks = mddev->resync_max_sectors;
1593         unsigned long chunks;
1594         unsigned long pages;
1595         struct file *file = mddev->bitmap_file;
1596         int err;
1597         sector_t start;
1598
1599         BUILD_BUG_ON(sizeof(bitmap_super_t) != 256);
1600
1601         if (!file && !mddev->bitmap_offset) /* bitmap disabled, nothing to do */
1602                 return 0;
1603
1604         BUG_ON(file && mddev->bitmap_offset);
1605
1606         bitmap = kzalloc(sizeof(*bitmap), GFP_KERNEL);
1607         if (!bitmap)
1608                 return -ENOMEM;
1609
1610         spin_lock_init(&bitmap->lock);
1611         atomic_set(&bitmap->pending_writes, 0);
1612         init_waitqueue_head(&bitmap->write_wait);
1613         init_waitqueue_head(&bitmap->overflow_wait);
1614
1615         bitmap->mddev = mddev;
1616
1617         bitmap->file = file;
1618         bitmap->offset = mddev->bitmap_offset;
1619         if (file) {
1620                 get_file(file);
1621                 do_sync_mapping_range(file->f_mapping, 0, LLONG_MAX,
1622                                       SYNC_FILE_RANGE_WAIT_BEFORE |
1623                                       SYNC_FILE_RANGE_WRITE |
1624                                       SYNC_FILE_RANGE_WAIT_AFTER);
1625         }
1626         /* read superblock from bitmap file (this sets bitmap->chunksize) */
1627         err = bitmap_read_sb(bitmap);
1628         if (err)
1629                 goto error;
1630
1631         bitmap->chunkshift = ffz(~bitmap->chunksize);
1632
1633         /* now that chunksize and chunkshift are set, we can use these macros */
1634         chunks = (blocks + CHUNK_BLOCK_RATIO(bitmap) - 1) /
1635                         CHUNK_BLOCK_RATIO(bitmap);
1636         pages = (chunks + PAGE_COUNTER_RATIO - 1) / PAGE_COUNTER_RATIO;
1637
1638         BUG_ON(!pages);
1639
1640         bitmap->chunks = chunks;
1641         bitmap->pages = pages;
1642         bitmap->missing_pages = pages;
1643         bitmap->counter_bits = COUNTER_BITS;
1644
1645         bitmap->syncchunk = ~0UL;
1646
1647 #ifdef INJECT_FATAL_FAULT_1
1648         bitmap->bp = NULL;
1649 #else
1650         bitmap->bp = kzalloc(pages * sizeof(*bitmap->bp), GFP_KERNEL);
1651 #endif
1652         err = -ENOMEM;
1653         if (!bitmap->bp)
1654                 goto error;
1655
1656         /* now that we have some pages available, initialize the in-memory
1657          * bitmap from the on-disk bitmap */
1658         start = 0;
1659         if (mddev->degraded == 0
1660             || bitmap->events_cleared == mddev->events)
1661                 /* no need to keep dirty bits to optimise a re-add of a missing device */
1662                 start = mddev->recovery_cp;
1663         err = bitmap_init_from_disk(bitmap, start);
1664
1665         if (err)
1666                 goto error;
1667
1668         printk(KERN_INFO "created bitmap (%lu pages) for device %s\n",
1669                 pages, bmname(bitmap));
1670
1671         mddev->bitmap = bitmap;
1672
1673         mddev->thread->timeout = bitmap->daemon_sleep * HZ;
1674
1675         bitmap_update_sb(bitmap);
1676
1677         return (bitmap->flags & BITMAP_WRITE_ERROR) ? -EIO : 0;
1678
1679  error:
1680         bitmap_free(bitmap);
1681         return err;
1682 }
1683
1684 /* the bitmap API -- for raid personalities */
1685 EXPORT_SYMBOL(bitmap_startwrite);
1686 EXPORT_SYMBOL(bitmap_endwrite);
1687 EXPORT_SYMBOL(bitmap_start_sync);
1688 EXPORT_SYMBOL(bitmap_end_sync);
1689 EXPORT_SYMBOL(bitmap_unplug);
1690 EXPORT_SYMBOL(bitmap_close_sync);
1691 EXPORT_SYMBOL(bitmap_cond_end_sync);