extern long total_swap_pages;
 extern void si_swapinfo(struct sysinfo *);
 extern swp_entry_t get_swap_page(void);
-extern swp_entry_t get_swap_page_of_type(int);
 extern int valid_swaphandles(swp_entry_t, unsigned long *);
 extern int add_swap_count_continuation(swp_entry_t, gfp_t);
 extern void swap_shmem_alloc(swp_entry_t);
 extern int try_to_free_swap(struct page *);
 struct backing_dev_info;
 
+#ifdef CONFIG_HIBERNATION
+void hibernation_freeze_swap(void);
+void hibernation_thaw_swap(void);
+swp_entry_t get_swap_for_hibernation(int type);
+void swap_free_for_hibernation(swp_entry_t val);
+#endif
+
 /* linux/mm/thrash.c */
 extern struct mm_struct *swap_token_mm;
 extern void grab_swap_token(struct mm_struct *);
 
 {
        unsigned long offset;
 
-       offset = swp_offset(get_swap_page_of_type(swap));
+       offset = swp_offset(get_swap_for_hibernation(swap));
        if (offset) {
                if (swsusp_extents_insert(offset))
-                       swap_free(swp_entry(swap, offset));
+                       swap_free_for_hibernation(swp_entry(swap, offset));
                else
                        return swapdev_block(swap, offset);
        }
                ext = container_of(node, struct swsusp_extent, node);
                rb_erase(node, &swsusp_extents);
                for (offset = ext->start; offset <= ext->end; offset++)
-                       swap_free(swp_entry(swap, offset));
+                       swap_free_for_hibernation(swp_entry(swap, offset));
 
                kfree(ext);
        }
 
 long total_swap_pages;
 static int least_priority;
 
+static bool swap_for_hibernation;
+
 static const char Bad_file[] = "Bad swap file entry ";
 static const char Unused_file[] = "Unused swap file entry ";
 static const char Bad_offset[] = "Bad swap offset entry ";
        spin_lock(&swap_lock);
        if (nr_swap_pages <= 0)
                goto noswap;
+       if (swap_for_hibernation)
+               goto noswap;
        nr_swap_pages--;
 
        for (type = swap_list.next; type >= 0 && wrapped < 2; type = next) {
        return (swp_entry_t) {0};
 }
 
-/* The only caller of this function is now susupend routine */
-swp_entry_t get_swap_page_of_type(int type)
-{
-       struct swap_info_struct *si;
-       pgoff_t offset;
-
-       spin_lock(&swap_lock);
-       si = swap_info[type];
-       if (si && (si->flags & SWP_WRITEOK)) {
-               nr_swap_pages--;
-               /* This is called for allocating swap entry, not cache */
-               offset = scan_swap_map(si, 1);
-               if (offset) {
-                       spin_unlock(&swap_lock);
-                       return swp_entry(type, offset);
-               }
-               nr_swap_pages++;
-       }
-       spin_unlock(&swap_lock);
-       return (swp_entry_t) {0};
-}
-
 static struct swap_info_struct *swap_info_get(swp_entry_t entry)
 {
        struct swap_info_struct *p;
 #endif
 
 #ifdef CONFIG_HIBERNATION
+
+static pgoff_t hibernation_offset[MAX_SWAPFILES];
+/*
+ * Once hibernation starts to use swap, we freeze swap_map[]. Otherwise,
+ * saved swap_map[] image to the disk will be an incomplete because it's
+ * changing without synchronization with hibernation snap shot.
+ * At resume, we just make swap_for_hibernation=false. We can forget
+ * used maps easily.
+ */
+void hibernation_freeze_swap(void)
+{
+       int i;
+
+       spin_lock(&swap_lock);
+
+       printk(KERN_INFO "PM: Freeze Swap\n");
+       swap_for_hibernation = true;
+       for (i = 0; i < MAX_SWAPFILES; i++)
+               hibernation_offset[i] = 1;
+       spin_unlock(&swap_lock);
+}
+
+void hibernation_thaw_swap(void)
+{
+       spin_lock(&swap_lock);
+       if (swap_for_hibernation) {
+               printk(KERN_INFO "PM: Thaw Swap\n");
+               swap_for_hibernation = false;
+       }
+       spin_unlock(&swap_lock);
+}
+
+/*
+ * Because updateing swap_map[] can make not-saved-status-change,
+ * we use our own easy allocator.
+ * Please see kernel/power/swap.c, Used swaps are recorded into
+ * RB-tree.
+ */
+swp_entry_t get_swap_for_hibernation(int type)
+{
+       pgoff_t off;
+       swp_entry_t val = {0};
+       struct swap_info_struct *si;
+
+       spin_lock(&swap_lock);
+
+       si = swap_info[type];
+       if (!si || !(si->flags & SWP_WRITEOK))
+               goto done;
+
+       for (off = hibernation_offset[type]; off < si->max; ++off) {
+               if (!si->swap_map[off])
+                       break;
+       }
+       if (off < si->max) {
+               val = swp_entry(type, off);
+               hibernation_offset[type] = off + 1;
+       }
+done:
+       spin_unlock(&swap_lock);
+       return val;
+}
+
+void swap_free_for_hibernation(swp_entry_t ent)
+{
+       /* Nothing to do */
+}
+
 /*
  * Find the swap type that corresponds to given device (if any).
  *