#include <linux/sched.h>
 #include <linux/seq_file.h>
 #include <linux/bootmem.h>
+#include <linux/slab.h>
 
 #include <asm/cache.h>
 #include <asm/setup.h>
  */
 RESERVE_BRK(p2m_identity_remap, PAGE_SIZE * 2 * 3 * MAX_REMAP_RANGES);
 
+static int use_brk = 1;
+
 static inline unsigned p2m_top_index(unsigned long pfn)
 {
        BUG_ON(pfn >= MAX_P2M_PFN);
                p2m[i] = INVALID_P2M_ENTRY;
 }
 
+static void * __ref alloc_p2m_page(void)
+{
+       if (unlikely(use_brk))
+               return extend_brk(PAGE_SIZE, PAGE_SIZE);
+
+       if (unlikely(!slab_is_available()))
+               return alloc_bootmem_align(PAGE_SIZE, PAGE_SIZE);
+
+       return (void *)__get_free_page(GFP_KERNEL | __GFP_REPEAT);
+}
+
+/* Only to be called in case of a race for a page just allocated! */
+static void free_p2m_page(void *p)
+{
+       BUG_ON(!slab_is_available());
+       free_page((unsigned long)p);
+}
+
 /*
  * Build the parallel p2m_top_mfn and p2m_mid_mfn structures
  *
 
        /* Pre-initialize p2m_top_mfn to be completely missing */
        if (p2m_top_mfn == NULL) {
-               p2m_mid_missing_mfn = alloc_bootmem_align(PAGE_SIZE, PAGE_SIZE);
+               p2m_mid_missing_mfn = alloc_p2m_page();
                p2m_mid_mfn_init(p2m_mid_missing_mfn, p2m_missing);
 
-               p2m_top_mfn_p = alloc_bootmem_align(PAGE_SIZE, PAGE_SIZE);
+               p2m_top_mfn_p = alloc_p2m_page();
                p2m_top_mfn_p_init(p2m_top_mfn_p);
 
-               p2m_top_mfn = alloc_bootmem_align(PAGE_SIZE, PAGE_SIZE);
+               p2m_top_mfn = alloc_p2m_page();
                p2m_top_mfn_init(p2m_top_mfn);
        } else {
                /* Reinitialise, mfn's all change after migration */
                         * missing parts of the mfn tree after
                         * runtime.
                         */
-                       mid_mfn_p = alloc_bootmem_align(PAGE_SIZE, PAGE_SIZE);
+                       mid_mfn_p = alloc_p2m_page();
                        p2m_mid_mfn_init(mid_mfn_p, p2m_missing);
 
                        p2m_top_mfn_p[topidx] = mid_mfn_p;
        max_pfn = min(MAX_DOMAIN_PAGES, xen_start_info->nr_pages);
        xen_max_p2m_pfn = max_pfn;
 
-       p2m_missing = extend_brk(PAGE_SIZE, PAGE_SIZE);
+       p2m_missing = alloc_p2m_page();
        p2m_init(p2m_missing);
-       p2m_identity = extend_brk(PAGE_SIZE, PAGE_SIZE);
+       p2m_identity = alloc_p2m_page();
        p2m_init(p2m_identity);
 
-       p2m_mid_missing = extend_brk(PAGE_SIZE, PAGE_SIZE);
+       p2m_mid_missing = alloc_p2m_page();
        p2m_mid_init(p2m_mid_missing, p2m_missing);
-       p2m_mid_identity = extend_brk(PAGE_SIZE, PAGE_SIZE);
+       p2m_mid_identity = alloc_p2m_page();
        p2m_mid_init(p2m_mid_identity, p2m_identity);
 
-       p2m_top = extend_brk(PAGE_SIZE, PAGE_SIZE);
+       p2m_top = alloc_p2m_page();
        p2m_top_init(p2m_top);
 
        /*
                unsigned mididx = p2m_mid_index(pfn);
 
                if (p2m_top[topidx] == p2m_mid_missing) {
-                       unsigned long **mid = extend_brk(PAGE_SIZE, PAGE_SIZE);
+                       unsigned long **mid = alloc_p2m_page();
                        p2m_mid_init(mid, p2m_missing);
 
                        p2m_top[topidx] = mid;
        unsigned long *mfn_list = NULL;
        unsigned long size;
 
+       use_brk = 0;
        va_start = xen_start_info->mfn_list;
        /*We copy in increments of P2M_PER_PAGE * sizeof(unsigned long),
         * so make sure it is rounded up to that */
 #else
 unsigned long __init xen_revector_p2m_tree(void)
 {
+       use_brk = 0;
        return 0;
 }
 #endif
 }
 EXPORT_SYMBOL_GPL(get_phys_to_machine);
 
-static void *alloc_p2m_page(void)
-{
-       return (void *)__get_free_page(GFP_KERNEL | __GFP_REPEAT);
-}
-
-static void free_p2m_page(void *p)
-{
-       free_page((unsigned long)p);
-}
-
 /*
  * Fully allocate the p2m structure for a given pfn.  We need to check
  * that both the top and mid levels are allocated, and make sure the
                return false;
 
        /* Boundary cross-over for the edges: */
-       p2m = extend_brk(PAGE_SIZE, PAGE_SIZE);
+       p2m = alloc_p2m_page();
 
        p2m_init(p2m);
 
 
        mid = p2m_top[topidx];
        if (mid == p2m_mid_missing) {
-               mid = extend_brk(PAGE_SIZE, PAGE_SIZE);
+               mid = alloc_p2m_page();
 
                p2m_mid_init(mid, p2m_missing);