p2m.c 39 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330
  1. /*
  2. * Xen leaves the responsibility for maintaining p2m mappings to the
  3. * guests themselves, but it must also access and update the p2m array
  4. * during suspend/resume when all the pages are reallocated.
  5. *
  6. * The p2m table is logically a flat array, but we implement it as a
  7. * three-level tree to allow the address space to be sparse.
  8. *
  9. * Xen
  10. * |
  11. * p2m_top p2m_top_mfn
  12. * / \ / \
  13. * p2m_mid p2m_mid p2m_mid_mfn p2m_mid_mfn
  14. * / \ / \ / /
  15. * p2m p2m p2m p2m p2m p2m p2m ...
  16. *
  17. * The p2m_mid_mfn pages are mapped by p2m_top_mfn_p.
  18. *
  19. * The p2m_top and p2m_top_mfn levels are limited to 1 page, so the
  20. * maximum representable pseudo-physical address space is:
  21. * P2M_TOP_PER_PAGE * P2M_MID_PER_PAGE * P2M_PER_PAGE pages
  22. *
  23. * P2M_PER_PAGE depends on the architecture, as a mfn is always
  24. * unsigned long (8 bytes on 64-bit, 4 bytes on 32), leading to
  25. * 512 and 1024 entries respectively.
  26. *
  27. * In short, these structures contain the Machine Frame Number (MFN) of the PFN.
  28. *
  29. * However not all entries are filled with MFNs. Specifically for all other
  30. * leaf entries, or for the top root, or middle one, for which there is a void
  31. * entry, we assume it is "missing". So (for example)
  32. * pfn_to_mfn(0x90909090)=INVALID_P2M_ENTRY.
  33. *
  34. * We also have the possibility of setting 1-1 mappings on certain regions, so
  35. * that:
  36. * pfn_to_mfn(0xc0000)=0xc0000
  37. *
  38. * The benefit of this is, that we can assume for non-RAM regions (think
  39. * PCI BARs, or ACPI spaces), we can create mappings easily because we
  40. * get the PFN value to match the MFN.
  41. *
  42. * For this to work efficiently we have one new page p2m_identity and
  43. * allocate (via reserved_brk) any other pages we need to cover the sides
  44. * (1GB or 4MB boundary violations). All entries in p2m_identity are set to
  45. * INVALID_P2M_ENTRY type (Xen toolstack only recognizes that and MFNs,
  46. * no other fancy value).
  47. *
  48. * On lookup we spot that the entry points to p2m_identity and return the
  49. * identity value instead of dereferencing and returning INVALID_P2M_ENTRY.
  50. * If the entry points to an allocated page, we just proceed as before and
  51. * return the PFN. If the PFN has IDENTITY_FRAME_BIT set we unmask that in
  52. * appropriate functions (pfn_to_mfn).
  53. *
  54. * The reason for having the IDENTITY_FRAME_BIT instead of just returning the
  55. * PFN is that we could find ourselves where pfn_to_mfn(pfn)==pfn for a
  56. * non-identity pfn. To protect ourselves against we elect to set (and get) the
  57. * IDENTITY_FRAME_BIT on all identity mapped PFNs.
  58. *
  59. * This simplistic diagram is used to explain the more subtle piece of code.
  60. * There is also a digram of the P2M at the end that can help.
  61. * Imagine your E820 looking as so:
  62. *
  63. * 1GB 2GB 4GB
  64. * /-------------------+---------\/----\ /----------\ /---+-----\
  65. * | System RAM | Sys RAM ||ACPI| | reserved | | Sys RAM |
  66. * \-------------------+---------/\----/ \----------/ \---+-----/
  67. * ^- 1029MB ^- 2001MB
  68. *
  69. * [1029MB = 263424 (0x40500), 2001MB = 512256 (0x7D100),
  70. * 2048MB = 524288 (0x80000)]
  71. *
  72. * And dom0_mem=max:3GB,1GB is passed in to the guest, meaning memory past 1GB
  73. * is actually not present (would have to kick the balloon driver to put it in).
  74. *
  75. * When we are told to set the PFNs for identity mapping (see patch: "xen/setup:
  76. * Set identity mapping for non-RAM E820 and E820 gaps.") we pass in the start
  77. * of the PFN and the end PFN (263424 and 512256 respectively). The first step
  78. * is to reserve_brk a top leaf page if the p2m[1] is missing. The top leaf page
  79. * covers 512^2 of page estate (1GB) and in case the start or end PFN is not
  80. * aligned on 512^2*PAGE_SIZE (1GB) we reserve_brk new middle and leaf pages as
  81. * required to split any existing p2m_mid_missing middle pages.
  82. *
  83. * With the E820 example above, 263424 is not 1GB aligned so we allocate a
  84. * reserve_brk page which will cover the PFNs estate from 0x40000 to 0x80000.
  85. * Each entry in the allocate page is "missing" (points to p2m_missing).
  86. *
  87. * Next stage is to determine if we need to do a more granular boundary check
  88. * on the 4MB (or 2MB depending on architecture) off the start and end pfn's.
  89. * We check if the start pfn and end pfn violate that boundary check, and if
  90. * so reserve_brk a (p2m[x][y]) leaf page. This way we have a much finer
  91. * granularity of setting which PFNs are missing and which ones are identity.
  92. * In our example 263424 and 512256 both fail the check so we reserve_brk two
  93. * pages. Populate them with INVALID_P2M_ENTRY (so they both have "missing"
  94. * values) and assign them to p2m[1][2] and p2m[1][488] respectively.
  95. *
  96. * At this point we would at minimum reserve_brk one page, but could be up to
  97. * three. Each call to set_phys_range_identity has at maximum a three page
  98. * cost. If we were to query the P2M at this stage, all those entries from
  99. * start PFN through end PFN (so 1029MB -> 2001MB) would return
  100. * INVALID_P2M_ENTRY ("missing").
  101. *
  102. * The next step is to walk from the start pfn to the end pfn setting
  103. * the IDENTITY_FRAME_BIT on each PFN. This is done in set_phys_range_identity.
  104. * If we find that the middle entry is pointing to p2m_missing we can swap it
  105. * over to p2m_identity - this way covering 4MB (or 2MB) PFN space (and
  106. * similarly swapping p2m_mid_missing for p2m_mid_identity for larger regions).
  107. * At this point we do not need to worry about boundary aligment (so no need to
  108. * reserve_brk a middle page, figure out which PFNs are "missing" and which
  109. * ones are identity), as that has been done earlier. If we find that the
  110. * middle leaf is not occupied by p2m_identity or p2m_missing, we dereference
  111. * that page (which covers 512 PFNs) and set the appropriate PFN with
  112. * IDENTITY_FRAME_BIT. In our example 263424 and 512256 end up there, and we
  113. * set from p2m[1][2][256->511] and p2m[1][488][0->256] with
  114. * IDENTITY_FRAME_BIT set.
  115. *
  116. * All other regions that are void (or not filled) either point to p2m_missing
  117. * (considered missing) or have the default value of INVALID_P2M_ENTRY (also
  118. * considered missing). In our case, p2m[1][2][0->255] and p2m[1][488][257->511]
  119. * contain the INVALID_P2M_ENTRY value and are considered "missing."
  120. *
  121. * Finally, the region beyond the end of of the E820 (4 GB in this example)
  122. * is set to be identity (in case there are MMIO regions placed here).
  123. *
  124. * This is what the p2m ends up looking (for the E820 above) with this
  125. * fabulous drawing:
  126. *
  127. * p2m /--------------\
  128. * /-----\ | &mfn_list[0],| /-----------------\
  129. * | 0 |------>| &mfn_list[1],| /---------------\ | ~0, ~0, .. |
  130. * |-----| | ..., ~0, ~0 | | ~0, ~0, [x]---+----->| IDENTITY [@256] |
  131. * | 1 |---\ \--------------/ | [p2m_identity]+\ | IDENTITY [@257] |
  132. * |-----| \ | [p2m_identity]+\\ | .... |
  133. * | 2 |--\ \-------------------->| ... | \\ \----------------/
  134. * |-----| \ \---------------/ \\
  135. * | 3 |-\ \ \\ p2m_identity [1]
  136. * |-----| \ \-------------------->/---------------\ /-----------------\
  137. * | .. |\ | | [p2m_identity]+-->| ~0, ~0, ~0, ... |
  138. * \-----/ | | | [p2m_identity]+-->| ..., ~0 |
  139. * | | | .... | \-----------------/
  140. * | | +-[x], ~0, ~0.. +\
  141. * | | \---------------/ \
  142. * | | \-> /---------------\
  143. * | V p2m_mid_missing p2m_missing | IDENTITY[@0] |
  144. * | /-----------------\ /------------\ | IDENTITY[@256]|
  145. * | | [p2m_missing] +---->| ~0, ~0, ...| | ~0, ~0, .... |
  146. * | | [p2m_missing] +---->| ..., ~0 | \---------------/
  147. * | | ... | \------------/
  148. * | \-----------------/
  149. * |
  150. * | p2m_mid_identity
  151. * | /-----------------\
  152. * \-->| [p2m_identity] +---->[1]
  153. * | [p2m_identity] +---->[1]
  154. * | ... |
  155. * \-----------------/
  156. *
  157. * where ~0 is INVALID_P2M_ENTRY. IDENTITY is (PFN | IDENTITY_BIT)
  158. */
  159. #include <linux/init.h>
  160. #include <linux/module.h>
  161. #include <linux/list.h>
  162. #include <linux/hash.h>
  163. #include <linux/sched.h>
  164. #include <linux/seq_file.h>
  165. #include <asm/cache.h>
  166. #include <asm/setup.h>
  167. #include <asm/xen/page.h>
  168. #include <asm/xen/hypercall.h>
  169. #include <asm/xen/hypervisor.h>
  170. #include <xen/balloon.h>
  171. #include <xen/grant_table.h>
  172. #include "p2m.h"
  173. #include "multicalls.h"
  174. #include "xen-ops.h"
  175. static void __init m2p_override_init(void);
  176. unsigned long xen_max_p2m_pfn __read_mostly;
  177. /* Placeholders for holes in the address space */
  178. static RESERVE_BRK_ARRAY(unsigned long, p2m_missing, P2M_PER_PAGE);
  179. static RESERVE_BRK_ARRAY(unsigned long *, p2m_mid_missing, P2M_MID_PER_PAGE);
  180. static RESERVE_BRK_ARRAY(unsigned long, p2m_mid_missing_mfn, P2M_MID_PER_PAGE);
  181. static RESERVE_BRK_ARRAY(unsigned long **, p2m_top, P2M_TOP_PER_PAGE);
  182. static RESERVE_BRK_ARRAY(unsigned long, p2m_top_mfn, P2M_TOP_PER_PAGE);
  183. static RESERVE_BRK_ARRAY(unsigned long *, p2m_top_mfn_p, P2M_TOP_PER_PAGE);
  184. static RESERVE_BRK_ARRAY(unsigned long, p2m_identity, P2M_PER_PAGE);
  185. static RESERVE_BRK_ARRAY(unsigned long *, p2m_mid_identity, P2M_MID_PER_PAGE);
  186. static RESERVE_BRK_ARRAY(unsigned long, p2m_mid_identity_mfn, P2M_MID_PER_PAGE);
  187. RESERVE_BRK(p2m_mid, PAGE_SIZE * (MAX_DOMAIN_PAGES / (P2M_PER_PAGE * P2M_MID_PER_PAGE)));
  188. RESERVE_BRK(p2m_mid_mfn, PAGE_SIZE * (MAX_DOMAIN_PAGES / (P2M_PER_PAGE * P2M_MID_PER_PAGE)));
  189. /* For each I/O range remapped we may lose up to two leaf pages for the boundary
  190. * violations and three mid pages to cover up to 3GB. With
  191. * early_can_reuse_p2m_middle() most of the leaf pages will be reused by the
  192. * remapped region.
  193. */
  194. RESERVE_BRK(p2m_identity_remap, PAGE_SIZE * 2 * 3 * MAX_REMAP_RANGES);
  195. static inline unsigned p2m_top_index(unsigned long pfn)
  196. {
  197. BUG_ON(pfn >= MAX_P2M_PFN);
  198. return pfn / (P2M_MID_PER_PAGE * P2M_PER_PAGE);
  199. }
  200. static inline unsigned p2m_mid_index(unsigned long pfn)
  201. {
  202. return (pfn / P2M_PER_PAGE) % P2M_MID_PER_PAGE;
  203. }
  204. static inline unsigned p2m_index(unsigned long pfn)
  205. {
  206. return pfn % P2M_PER_PAGE;
  207. }
  208. static void p2m_top_init(unsigned long ***top)
  209. {
  210. unsigned i;
  211. for (i = 0; i < P2M_TOP_PER_PAGE; i++)
  212. top[i] = p2m_mid_missing;
  213. }
  214. static void p2m_top_mfn_init(unsigned long *top)
  215. {
  216. unsigned i;
  217. for (i = 0; i < P2M_TOP_PER_PAGE; i++)
  218. top[i] = virt_to_mfn(p2m_mid_missing_mfn);
  219. }
  220. static void p2m_top_mfn_p_init(unsigned long **top)
  221. {
  222. unsigned i;
  223. for (i = 0; i < P2M_TOP_PER_PAGE; i++)
  224. top[i] = p2m_mid_missing_mfn;
  225. }
  226. static void p2m_mid_init(unsigned long **mid, unsigned long *leaf)
  227. {
  228. unsigned i;
  229. for (i = 0; i < P2M_MID_PER_PAGE; i++)
  230. mid[i] = leaf;
  231. }
  232. static void p2m_mid_mfn_init(unsigned long *mid, unsigned long *leaf)
  233. {
  234. unsigned i;
  235. for (i = 0; i < P2M_MID_PER_PAGE; i++)
  236. mid[i] = virt_to_mfn(leaf);
  237. }
  238. static void p2m_init(unsigned long *p2m)
  239. {
  240. unsigned i;
  241. for (i = 0; i < P2M_MID_PER_PAGE; i++)
  242. p2m[i] = INVALID_P2M_ENTRY;
  243. }
  244. /*
  245. * Build the parallel p2m_top_mfn and p2m_mid_mfn structures
  246. *
  247. * This is called both at boot time, and after resuming from suspend:
  248. * - At boot time we're called very early, and must use extend_brk()
  249. * to allocate memory.
  250. *
  251. * - After resume we're called from within stop_machine, but the mfn
  252. * tree should alreay be completely allocated.
  253. */
  254. void __ref xen_build_mfn_list_list(void)
  255. {
  256. unsigned long pfn;
  257. if (xen_feature(XENFEAT_auto_translated_physmap))
  258. return;
  259. /* Pre-initialize p2m_top_mfn to be completely missing */
  260. if (p2m_top_mfn == NULL) {
  261. p2m_mid_missing_mfn = extend_brk(PAGE_SIZE, PAGE_SIZE);
  262. p2m_mid_mfn_init(p2m_mid_missing_mfn, p2m_missing);
  263. p2m_mid_identity_mfn = extend_brk(PAGE_SIZE, PAGE_SIZE);
  264. p2m_mid_mfn_init(p2m_mid_identity_mfn, p2m_identity);
  265. p2m_top_mfn_p = extend_brk(PAGE_SIZE, PAGE_SIZE);
  266. p2m_top_mfn_p_init(p2m_top_mfn_p);
  267. p2m_top_mfn = extend_brk(PAGE_SIZE, PAGE_SIZE);
  268. p2m_top_mfn_init(p2m_top_mfn);
  269. } else {
  270. /* Reinitialise, mfn's all change after migration */
  271. p2m_mid_mfn_init(p2m_mid_missing_mfn, p2m_missing);
  272. p2m_mid_mfn_init(p2m_mid_identity_mfn, p2m_identity);
  273. }
  274. for (pfn = 0; pfn < xen_max_p2m_pfn; pfn += P2M_PER_PAGE) {
  275. unsigned topidx = p2m_top_index(pfn);
  276. unsigned mididx = p2m_mid_index(pfn);
  277. unsigned long **mid;
  278. unsigned long *mid_mfn_p;
  279. mid = p2m_top[topidx];
  280. mid_mfn_p = p2m_top_mfn_p[topidx];
  281. /* Don't bother allocating any mfn mid levels if
  282. * they're just missing, just update the stored mfn,
  283. * since all could have changed over a migrate.
  284. */
  285. if (mid == p2m_mid_missing) {
  286. BUG_ON(mididx);
  287. BUG_ON(mid_mfn_p != p2m_mid_missing_mfn);
  288. p2m_top_mfn[topidx] = virt_to_mfn(p2m_mid_missing_mfn);
  289. pfn += (P2M_MID_PER_PAGE - 1) * P2M_PER_PAGE;
  290. continue;
  291. }
  292. if (mid_mfn_p == p2m_mid_missing_mfn) {
  293. /*
  294. * XXX boot-time only! We should never find
  295. * missing parts of the mfn tree after
  296. * runtime. extend_brk() will BUG if we call
  297. * it too late.
  298. */
  299. mid_mfn_p = extend_brk(PAGE_SIZE, PAGE_SIZE);
  300. p2m_mid_mfn_init(mid_mfn_p, p2m_missing);
  301. p2m_top_mfn_p[topidx] = mid_mfn_p;
  302. }
  303. p2m_top_mfn[topidx] = virt_to_mfn(mid_mfn_p);
  304. mid_mfn_p[mididx] = virt_to_mfn(mid[mididx]);
  305. }
  306. }
  307. void xen_setup_mfn_list_list(void)
  308. {
  309. if (xen_feature(XENFEAT_auto_translated_physmap))
  310. return;
  311. BUG_ON(HYPERVISOR_shared_info == &xen_dummy_shared_info);
  312. HYPERVISOR_shared_info->arch.pfn_to_mfn_frame_list_list =
  313. virt_to_mfn(p2m_top_mfn);
  314. HYPERVISOR_shared_info->arch.max_pfn = xen_max_p2m_pfn;
  315. }
  316. /* Set up p2m_top to point to the domain-builder provided p2m pages */
  317. void __init xen_build_dynamic_phys_to_machine(void)
  318. {
  319. unsigned long *mfn_list;
  320. unsigned long max_pfn;
  321. unsigned long pfn;
  322. if (xen_feature(XENFEAT_auto_translated_physmap))
  323. return;
  324. mfn_list = (unsigned long *)xen_start_info->mfn_list;
  325. max_pfn = min(MAX_DOMAIN_PAGES, xen_start_info->nr_pages);
  326. xen_max_p2m_pfn = max_pfn;
  327. p2m_missing = extend_brk(PAGE_SIZE, PAGE_SIZE);
  328. p2m_init(p2m_missing);
  329. p2m_identity = extend_brk(PAGE_SIZE, PAGE_SIZE);
  330. p2m_init(p2m_identity);
  331. p2m_mid_missing = extend_brk(PAGE_SIZE, PAGE_SIZE);
  332. p2m_mid_init(p2m_mid_missing, p2m_missing);
  333. p2m_mid_identity = extend_brk(PAGE_SIZE, PAGE_SIZE);
  334. p2m_mid_init(p2m_mid_identity, p2m_identity);
  335. p2m_top = extend_brk(PAGE_SIZE, PAGE_SIZE);
  336. p2m_top_init(p2m_top);
  337. /*
  338. * The domain builder gives us a pre-constructed p2m array in
  339. * mfn_list for all the pages initially given to us, so we just
  340. * need to graft that into our tree structure.
  341. */
  342. for (pfn = 0; pfn < max_pfn; pfn += P2M_PER_PAGE) {
  343. unsigned topidx = p2m_top_index(pfn);
  344. unsigned mididx = p2m_mid_index(pfn);
  345. if (p2m_top[topidx] == p2m_mid_missing) {
  346. unsigned long **mid = extend_brk(PAGE_SIZE, PAGE_SIZE);
  347. p2m_mid_init(mid, p2m_missing);
  348. p2m_top[topidx] = mid;
  349. }
  350. /*
  351. * As long as the mfn_list has enough entries to completely
  352. * fill a p2m page, pointing into the array is ok. But if
  353. * not the entries beyond the last pfn will be undefined.
  354. */
  355. if (unlikely(pfn + P2M_PER_PAGE > max_pfn)) {
  356. unsigned long p2midx;
  357. p2midx = max_pfn % P2M_PER_PAGE;
  358. for ( ; p2midx < P2M_PER_PAGE; p2midx++)
  359. mfn_list[pfn + p2midx] = INVALID_P2M_ENTRY;
  360. }
  361. p2m_top[topidx][mididx] = &mfn_list[pfn];
  362. }
  363. m2p_override_init();
  364. }
  365. #ifdef CONFIG_X86_64
  366. #include <linux/bootmem.h>
  367. unsigned long __init xen_revector_p2m_tree(void)
  368. {
  369. unsigned long va_start;
  370. unsigned long va_end;
  371. unsigned long pfn;
  372. unsigned long pfn_free = 0;
  373. unsigned long *mfn_list = NULL;
  374. unsigned long size;
  375. va_start = xen_start_info->mfn_list;
  376. /*We copy in increments of P2M_PER_PAGE * sizeof(unsigned long),
  377. * so make sure it is rounded up to that */
  378. size = PAGE_ALIGN(xen_start_info->nr_pages * sizeof(unsigned long));
  379. va_end = va_start + size;
  380. /* If we were revectored already, don't do it again. */
  381. if (va_start <= __START_KERNEL_map && va_start >= __PAGE_OFFSET)
  382. return 0;
  383. mfn_list = alloc_bootmem_align(size, PAGE_SIZE);
  384. if (!mfn_list) {
  385. pr_warn("Could not allocate space for a new P2M tree!\n");
  386. return xen_start_info->mfn_list;
  387. }
  388. /* Fill it out with INVALID_P2M_ENTRY value */
  389. memset(mfn_list, 0xFF, size);
  390. for (pfn = 0; pfn < ALIGN(MAX_DOMAIN_PAGES, P2M_PER_PAGE); pfn += P2M_PER_PAGE) {
  391. unsigned topidx = p2m_top_index(pfn);
  392. unsigned mididx;
  393. unsigned long *mid_p;
  394. if (!p2m_top[topidx])
  395. continue;
  396. if (p2m_top[topidx] == p2m_mid_missing)
  397. continue;
  398. mididx = p2m_mid_index(pfn);
  399. mid_p = p2m_top[topidx][mididx];
  400. if (!mid_p)
  401. continue;
  402. if ((mid_p == p2m_missing) || (mid_p == p2m_identity))
  403. continue;
  404. if ((unsigned long)mid_p == INVALID_P2M_ENTRY)
  405. continue;
  406. /* The old va. Rebase it on mfn_list */
  407. if (mid_p >= (unsigned long *)va_start && mid_p <= (unsigned long *)va_end) {
  408. unsigned long *new;
  409. if (pfn_free > (size / sizeof(unsigned long))) {
  410. WARN(1, "Only allocated for %ld pages, but we want %ld!\n",
  411. size / sizeof(unsigned long), pfn_free);
  412. return 0;
  413. }
  414. new = &mfn_list[pfn_free];
  415. copy_page(new, mid_p);
  416. p2m_top[topidx][mididx] = &mfn_list[pfn_free];
  417. p2m_top_mfn_p[topidx][mididx] = virt_to_mfn(&mfn_list[pfn_free]);
  418. pfn_free += P2M_PER_PAGE;
  419. }
  420. /* This should be the leafs allocated for identity from _brk. */
  421. }
  422. return (unsigned long)mfn_list;
  423. }
  424. #else
  425. unsigned long __init xen_revector_p2m_tree(void)
  426. {
  427. return 0;
  428. }
  429. #endif
  430. unsigned long get_phys_to_machine(unsigned long pfn)
  431. {
  432. unsigned topidx, mididx, idx;
  433. if (unlikely(pfn >= MAX_P2M_PFN))
  434. return IDENTITY_FRAME(pfn);
  435. topidx = p2m_top_index(pfn);
  436. mididx = p2m_mid_index(pfn);
  437. idx = p2m_index(pfn);
  438. /*
  439. * The INVALID_P2M_ENTRY is filled in both p2m_*identity
  440. * and in p2m_*missing, so returning the INVALID_P2M_ENTRY
  441. * would be wrong.
  442. */
  443. if (p2m_top[topidx][mididx] == p2m_identity)
  444. return IDENTITY_FRAME(pfn);
  445. return p2m_top[topidx][mididx][idx];
  446. }
  447. EXPORT_SYMBOL_GPL(get_phys_to_machine);
  448. static void *alloc_p2m_page(void)
  449. {
  450. return (void *)__get_free_page(GFP_KERNEL | __GFP_REPEAT);
  451. }
  452. static void free_p2m_page(void *p)
  453. {
  454. free_page((unsigned long)p);
  455. }
  456. /*
  457. * Fully allocate the p2m structure for a given pfn. We need to check
  458. * that both the top and mid levels are allocated, and make sure the
  459. * parallel mfn tree is kept in sync. We may race with other cpus, so
  460. * the new pages are installed with cmpxchg; if we lose the race then
  461. * simply free the page we allocated and use the one that's there.
  462. */
  463. static bool alloc_p2m(unsigned long pfn)
  464. {
  465. unsigned topidx, mididx;
  466. unsigned long ***top_p, **mid;
  467. unsigned long *top_mfn_p, *mid_mfn;
  468. topidx = p2m_top_index(pfn);
  469. mididx = p2m_mid_index(pfn);
  470. top_p = &p2m_top[topidx];
  471. mid = *top_p;
  472. if (mid == p2m_mid_missing) {
  473. /* Mid level is missing, allocate a new one */
  474. mid = alloc_p2m_page();
  475. if (!mid)
  476. return false;
  477. p2m_mid_init(mid, p2m_missing);
  478. if (cmpxchg(top_p, p2m_mid_missing, mid) != p2m_mid_missing)
  479. free_p2m_page(mid);
  480. }
  481. top_mfn_p = &p2m_top_mfn[topidx];
  482. mid_mfn = p2m_top_mfn_p[topidx];
  483. BUG_ON(virt_to_mfn(mid_mfn) != *top_mfn_p);
  484. if (mid_mfn == p2m_mid_missing_mfn) {
  485. /* Separately check the mid mfn level */
  486. unsigned long missing_mfn;
  487. unsigned long mid_mfn_mfn;
  488. mid_mfn = alloc_p2m_page();
  489. if (!mid_mfn)
  490. return false;
  491. p2m_mid_mfn_init(mid_mfn, p2m_missing);
  492. missing_mfn = virt_to_mfn(p2m_mid_missing_mfn);
  493. mid_mfn_mfn = virt_to_mfn(mid_mfn);
  494. if (cmpxchg(top_mfn_p, missing_mfn, mid_mfn_mfn) != missing_mfn)
  495. free_p2m_page(mid_mfn);
  496. else
  497. p2m_top_mfn_p[topidx] = mid_mfn;
  498. }
  499. if (p2m_top[topidx][mididx] == p2m_identity ||
  500. p2m_top[topidx][mididx] == p2m_missing) {
  501. /* p2m leaf page is missing */
  502. unsigned long *p2m;
  503. unsigned long *p2m_orig = p2m_top[topidx][mididx];
  504. p2m = alloc_p2m_page();
  505. if (!p2m)
  506. return false;
  507. p2m_init(p2m);
  508. if (cmpxchg(&mid[mididx], p2m_orig, p2m) != p2m_orig)
  509. free_p2m_page(p2m);
  510. else
  511. mid_mfn[mididx] = virt_to_mfn(p2m);
  512. }
  513. return true;
  514. }
  515. static bool __init early_alloc_p2m(unsigned long pfn, bool check_boundary)
  516. {
  517. unsigned topidx, mididx, idx;
  518. unsigned long *p2m;
  519. unsigned long *mid_mfn_p;
  520. topidx = p2m_top_index(pfn);
  521. mididx = p2m_mid_index(pfn);
  522. idx = p2m_index(pfn);
  523. /* Pfff.. No boundary cross-over, lets get out. */
  524. if (!idx && check_boundary)
  525. return false;
  526. WARN(p2m_top[topidx][mididx] == p2m_identity,
  527. "P2M[%d][%d] == IDENTITY, should be MISSING (or alloced)!\n",
  528. topidx, mididx);
  529. /*
  530. * Could be done by xen_build_dynamic_phys_to_machine..
  531. */
  532. if (p2m_top[topidx][mididx] != p2m_missing)
  533. return false;
  534. /* Boundary cross-over for the edges: */
  535. p2m = extend_brk(PAGE_SIZE, PAGE_SIZE);
  536. p2m_init(p2m);
  537. p2m_top[topidx][mididx] = p2m;
  538. /* For save/restore we need to MFN of the P2M saved */
  539. mid_mfn_p = p2m_top_mfn_p[topidx];
  540. WARN(mid_mfn_p[mididx] != virt_to_mfn(p2m_missing),
  541. "P2M_TOP_P[%d][%d] != MFN of p2m_missing!\n",
  542. topidx, mididx);
  543. mid_mfn_p[mididx] = virt_to_mfn(p2m);
  544. return true;
  545. }
  546. static bool __init early_alloc_p2m_middle(unsigned long pfn)
  547. {
  548. unsigned topidx = p2m_top_index(pfn);
  549. unsigned long *mid_mfn_p;
  550. unsigned long **mid;
  551. mid = p2m_top[topidx];
  552. mid_mfn_p = p2m_top_mfn_p[topidx];
  553. if (mid == p2m_mid_missing) {
  554. mid = extend_brk(PAGE_SIZE, PAGE_SIZE);
  555. p2m_mid_init(mid, p2m_missing);
  556. p2m_top[topidx] = mid;
  557. BUG_ON(mid_mfn_p != p2m_mid_missing_mfn);
  558. }
  559. /* And the save/restore P2M tables.. */
  560. if (mid_mfn_p == p2m_mid_missing_mfn) {
  561. mid_mfn_p = extend_brk(PAGE_SIZE, PAGE_SIZE);
  562. p2m_mid_mfn_init(mid_mfn_p, p2m_missing);
  563. p2m_top_mfn_p[topidx] = mid_mfn_p;
  564. p2m_top_mfn[topidx] = virt_to_mfn(mid_mfn_p);
  565. /* Note: we don't set mid_mfn_p[midix] here,
  566. * look in early_alloc_p2m() */
  567. }
  568. return true;
  569. }
  570. /*
  571. * Skim over the P2M tree looking at pages that are either filled with
  572. * INVALID_P2M_ENTRY or with 1:1 PFNs. If found, re-use that page and
  573. * replace the P2M leaf with a p2m_missing or p2m_identity.
  574. * Stick the old page in the new P2M tree location.
  575. */
  576. bool __init early_can_reuse_p2m_middle(unsigned long set_pfn, unsigned long set_mfn)
  577. {
  578. unsigned topidx;
  579. unsigned mididx;
  580. unsigned ident_pfns;
  581. unsigned inv_pfns;
  582. unsigned long *p2m;
  583. unsigned long *mid_mfn_p;
  584. unsigned idx;
  585. unsigned long pfn;
  586. /* We only look when this entails a P2M middle layer */
  587. if (p2m_index(set_pfn))
  588. return false;
  589. for (pfn = 0; pfn < MAX_DOMAIN_PAGES; pfn += P2M_PER_PAGE) {
  590. topidx = p2m_top_index(pfn);
  591. if (!p2m_top[topidx])
  592. continue;
  593. if (p2m_top[topidx] == p2m_mid_missing)
  594. continue;
  595. mididx = p2m_mid_index(pfn);
  596. p2m = p2m_top[topidx][mididx];
  597. if (!p2m)
  598. continue;
  599. if ((p2m == p2m_missing) || (p2m == p2m_identity))
  600. continue;
  601. if ((unsigned long)p2m == INVALID_P2M_ENTRY)
  602. continue;
  603. ident_pfns = 0;
  604. inv_pfns = 0;
  605. for (idx = 0; idx < P2M_PER_PAGE; idx++) {
  606. /* IDENTITY_PFNs are 1:1 */
  607. if (p2m[idx] == IDENTITY_FRAME(pfn + idx))
  608. ident_pfns++;
  609. else if (p2m[idx] == INVALID_P2M_ENTRY)
  610. inv_pfns++;
  611. else
  612. break;
  613. }
  614. if ((ident_pfns == P2M_PER_PAGE) || (inv_pfns == P2M_PER_PAGE))
  615. goto found;
  616. }
  617. return false;
  618. found:
  619. /* Found one, replace old with p2m_identity or p2m_missing */
  620. p2m_top[topidx][mididx] = (ident_pfns ? p2m_identity : p2m_missing);
  621. /* And the other for save/restore.. */
  622. mid_mfn_p = p2m_top_mfn_p[topidx];
  623. /* NOTE: Even if it is a p2m_identity it should still be point to
  624. * a page filled with INVALID_P2M_ENTRY entries. */
  625. mid_mfn_p[mididx] = virt_to_mfn(p2m_missing);
  626. /* Reset where we want to stick the old page in. */
  627. topidx = p2m_top_index(set_pfn);
  628. mididx = p2m_mid_index(set_pfn);
  629. /* This shouldn't happen */
  630. if (WARN_ON(p2m_top[topidx] == p2m_mid_missing))
  631. early_alloc_p2m_middle(set_pfn);
  632. if (WARN_ON(p2m_top[topidx][mididx] != p2m_missing))
  633. return false;
  634. p2m_init(p2m);
  635. p2m_top[topidx][mididx] = p2m;
  636. mid_mfn_p = p2m_top_mfn_p[topidx];
  637. mid_mfn_p[mididx] = virt_to_mfn(p2m);
  638. return true;
  639. }
  640. bool __init early_set_phys_to_machine(unsigned long pfn, unsigned long mfn)
  641. {
  642. if (unlikely(!__set_phys_to_machine(pfn, mfn))) {
  643. if (!early_alloc_p2m_middle(pfn))
  644. return false;
  645. if (early_can_reuse_p2m_middle(pfn, mfn))
  646. return __set_phys_to_machine(pfn, mfn);
  647. if (!early_alloc_p2m(pfn, false /* boundary crossover OK!*/))
  648. return false;
  649. if (!__set_phys_to_machine(pfn, mfn))
  650. return false;
  651. }
  652. return true;
  653. }
  654. static void __init early_split_p2m(unsigned long pfn)
  655. {
  656. unsigned long mididx, idx;
  657. mididx = p2m_mid_index(pfn);
  658. idx = p2m_index(pfn);
  659. /*
  660. * Allocate new middle and leaf pages if this pfn lies in the
  661. * middle of one.
  662. */
  663. if (mididx || idx)
  664. early_alloc_p2m_middle(pfn);
  665. if (idx)
  666. early_alloc_p2m(pfn, false);
  667. }
  668. unsigned long __init set_phys_range_identity(unsigned long pfn_s,
  669. unsigned long pfn_e)
  670. {
  671. unsigned long pfn;
  672. if (unlikely(pfn_s >= MAX_P2M_PFN))
  673. return 0;
  674. if (unlikely(xen_feature(XENFEAT_auto_translated_physmap)))
  675. return pfn_e - pfn_s;
  676. if (pfn_s > pfn_e)
  677. return 0;
  678. if (pfn_e > MAX_P2M_PFN)
  679. pfn_e = MAX_P2M_PFN;
  680. early_split_p2m(pfn_s);
  681. early_split_p2m(pfn_e);
  682. for (pfn = pfn_s; pfn < pfn_e;) {
  683. unsigned topidx = p2m_top_index(pfn);
  684. unsigned mididx = p2m_mid_index(pfn);
  685. if (!__set_phys_to_machine(pfn, IDENTITY_FRAME(pfn)))
  686. break;
  687. pfn++;
  688. /*
  689. * If the PFN was set to a middle or leaf identity
  690. * page the remainder must also be identity, so skip
  691. * ahead to the next middle or leaf entry.
  692. */
  693. if (p2m_top[topidx] == p2m_mid_identity)
  694. pfn = ALIGN(pfn, P2M_MID_PER_PAGE * P2M_PER_PAGE);
  695. else if (p2m_top[topidx][mididx] == p2m_identity)
  696. pfn = ALIGN(pfn, P2M_PER_PAGE);
  697. }
  698. WARN((pfn - pfn_s) != (pfn_e - pfn_s),
  699. "Identity mapping failed. We are %ld short of 1-1 mappings!\n",
  700. (pfn_e - pfn_s) - (pfn - pfn_s));
  701. return pfn - pfn_s;
  702. }
  703. /* Try to install p2m mapping; fail if intermediate bits missing */
  704. bool __set_phys_to_machine(unsigned long pfn, unsigned long mfn)
  705. {
  706. unsigned topidx, mididx, idx;
  707. /* don't track P2M changes in autotranslate guests */
  708. if (unlikely(xen_feature(XENFEAT_auto_translated_physmap)))
  709. return true;
  710. if (unlikely(pfn >= MAX_P2M_PFN)) {
  711. BUG_ON(mfn != INVALID_P2M_ENTRY);
  712. return true;
  713. }
  714. topidx = p2m_top_index(pfn);
  715. mididx = p2m_mid_index(pfn);
  716. idx = p2m_index(pfn);
  717. /* For sparse holes were the p2m leaf has real PFN along with
  718. * PCI holes, stick in the PFN as the MFN value.
  719. *
  720. * set_phys_range_identity() will have allocated new middle
  721. * and leaf pages as required so an existing p2m_mid_missing
  722. * or p2m_missing mean that whole range will be identity so
  723. * these can be switched to p2m_mid_identity or p2m_identity.
  724. */
  725. if (mfn != INVALID_P2M_ENTRY && (mfn & IDENTITY_FRAME_BIT)) {
  726. if (p2m_top[topidx] == p2m_mid_identity)
  727. return true;
  728. if (p2m_top[topidx] == p2m_mid_missing) {
  729. WARN_ON(cmpxchg(&p2m_top[topidx], p2m_mid_missing,
  730. p2m_mid_identity) != p2m_mid_missing);
  731. return true;
  732. }
  733. if (p2m_top[topidx][mididx] == p2m_identity)
  734. return true;
  735. /* Swap over from MISSING to IDENTITY if needed. */
  736. if (p2m_top[topidx][mididx] == p2m_missing) {
  737. WARN_ON(cmpxchg(&p2m_top[topidx][mididx], p2m_missing,
  738. p2m_identity) != p2m_missing);
  739. return true;
  740. }
  741. }
  742. if (p2m_top[topidx][mididx] == p2m_missing)
  743. return mfn == INVALID_P2M_ENTRY;
  744. p2m_top[topidx][mididx][idx] = mfn;
  745. return true;
  746. }
  747. bool set_phys_to_machine(unsigned long pfn, unsigned long mfn)
  748. {
  749. if (unlikely(!__set_phys_to_machine(pfn, mfn))) {
  750. if (!alloc_p2m(pfn))
  751. return false;
  752. if (!__set_phys_to_machine(pfn, mfn))
  753. return false;
  754. }
  755. return true;
  756. }
  757. #define M2P_OVERRIDE_HASH_SHIFT 10
  758. #define M2P_OVERRIDE_HASH (1 << M2P_OVERRIDE_HASH_SHIFT)
  759. static RESERVE_BRK_ARRAY(struct list_head, m2p_overrides, M2P_OVERRIDE_HASH);
  760. static DEFINE_SPINLOCK(m2p_override_lock);
  761. static void __init m2p_override_init(void)
  762. {
  763. unsigned i;
  764. m2p_overrides = extend_brk(sizeof(*m2p_overrides) * M2P_OVERRIDE_HASH,
  765. sizeof(unsigned long));
  766. for (i = 0; i < M2P_OVERRIDE_HASH; i++)
  767. INIT_LIST_HEAD(&m2p_overrides[i]);
  768. }
  769. static unsigned long mfn_hash(unsigned long mfn)
  770. {
  771. return hash_long(mfn, M2P_OVERRIDE_HASH_SHIFT);
  772. }
  773. int set_foreign_p2m_mapping(struct gnttab_map_grant_ref *map_ops,
  774. struct gnttab_map_grant_ref *kmap_ops,
  775. struct page **pages, unsigned int count)
  776. {
  777. int i, ret = 0;
  778. bool lazy = false;
  779. pte_t *pte;
  780. if (xen_feature(XENFEAT_auto_translated_physmap))
  781. return 0;
  782. if (kmap_ops &&
  783. !in_interrupt() &&
  784. paravirt_get_lazy_mode() == PARAVIRT_LAZY_NONE) {
  785. arch_enter_lazy_mmu_mode();
  786. lazy = true;
  787. }
  788. for (i = 0; i < count; i++) {
  789. unsigned long mfn, pfn;
  790. /* Do not add to override if the map failed. */
  791. if (map_ops[i].status)
  792. continue;
  793. if (map_ops[i].flags & GNTMAP_contains_pte) {
  794. pte = (pte_t *) (mfn_to_virt(PFN_DOWN(map_ops[i].host_addr)) +
  795. (map_ops[i].host_addr & ~PAGE_MASK));
  796. mfn = pte_mfn(*pte);
  797. } else {
  798. mfn = PFN_DOWN(map_ops[i].dev_bus_addr);
  799. }
  800. pfn = page_to_pfn(pages[i]);
  801. WARN_ON(PagePrivate(pages[i]));
  802. SetPagePrivate(pages[i]);
  803. set_page_private(pages[i], mfn);
  804. pages[i]->index = pfn_to_mfn(pfn);
  805. if (unlikely(!set_phys_to_machine(pfn, FOREIGN_FRAME(mfn)))) {
  806. ret = -ENOMEM;
  807. goto out;
  808. }
  809. if (kmap_ops) {
  810. ret = m2p_add_override(mfn, pages[i], &kmap_ops[i]);
  811. if (ret)
  812. goto out;
  813. }
  814. }
  815. out:
  816. if (lazy)
  817. arch_leave_lazy_mmu_mode();
  818. return ret;
  819. }
  820. EXPORT_SYMBOL_GPL(set_foreign_p2m_mapping);
  821. /* Add an MFN override for a particular page */
  822. int m2p_add_override(unsigned long mfn, struct page *page,
  823. struct gnttab_map_grant_ref *kmap_op)
  824. {
  825. unsigned long flags;
  826. unsigned long pfn;
  827. unsigned long uninitialized_var(address);
  828. unsigned level;
  829. pte_t *ptep = NULL;
  830. pfn = page_to_pfn(page);
  831. if (!PageHighMem(page)) {
  832. address = (unsigned long)__va(pfn << PAGE_SHIFT);
  833. ptep = lookup_address(address, &level);
  834. if (WARN(ptep == NULL || level != PG_LEVEL_4K,
  835. "m2p_add_override: pfn %lx not mapped", pfn))
  836. return -EINVAL;
  837. }
  838. if (kmap_op != NULL) {
  839. if (!PageHighMem(page)) {
  840. struct multicall_space mcs =
  841. xen_mc_entry(sizeof(*kmap_op));
  842. MULTI_grant_table_op(mcs.mc,
  843. GNTTABOP_map_grant_ref, kmap_op, 1);
  844. xen_mc_issue(PARAVIRT_LAZY_MMU);
  845. }
  846. }
  847. spin_lock_irqsave(&m2p_override_lock, flags);
  848. list_add(&page->lru, &m2p_overrides[mfn_hash(mfn)]);
  849. spin_unlock_irqrestore(&m2p_override_lock, flags);
  850. /* p2m(m2p(mfn)) == mfn: the mfn is already present somewhere in
  851. * this domain. Set the FOREIGN_FRAME_BIT in the p2m for the other
  852. * pfn so that the following mfn_to_pfn(mfn) calls will return the
  853. * pfn from the m2p_override (the backend pfn) instead.
  854. * We need to do this because the pages shared by the frontend
  855. * (xen-blkfront) can be already locked (lock_page, called by
  856. * do_read_cache_page); when the userspace backend tries to use them
  857. * with direct_IO, mfn_to_pfn returns the pfn of the frontend, so
  858. * do_blockdev_direct_IO is going to try to lock the same pages
  859. * again resulting in a deadlock.
  860. * As a side effect get_user_pages_fast might not be safe on the
  861. * frontend pages while they are being shared with the backend,
  862. * because mfn_to_pfn (that ends up being called by GUPF) will
  863. * return the backend pfn rather than the frontend pfn. */
  864. pfn = mfn_to_pfn_no_overrides(mfn);
  865. if (get_phys_to_machine(pfn) == mfn)
  866. set_phys_to_machine(pfn, FOREIGN_FRAME(mfn));
  867. return 0;
  868. }
  869. EXPORT_SYMBOL_GPL(m2p_add_override);
  870. int clear_foreign_p2m_mapping(struct gnttab_unmap_grant_ref *unmap_ops,
  871. struct gnttab_map_grant_ref *kmap_ops,
  872. struct page **pages, unsigned int count)
  873. {
  874. int i, ret = 0;
  875. bool lazy = false;
  876. if (xen_feature(XENFEAT_auto_translated_physmap))
  877. return 0;
  878. if (kmap_ops &&
  879. !in_interrupt() &&
  880. paravirt_get_lazy_mode() == PARAVIRT_LAZY_NONE) {
  881. arch_enter_lazy_mmu_mode();
  882. lazy = true;
  883. }
  884. for (i = 0; i < count; i++) {
  885. unsigned long mfn = get_phys_to_machine(page_to_pfn(pages[i]));
  886. unsigned long pfn = page_to_pfn(pages[i]);
  887. if (mfn == INVALID_P2M_ENTRY || !(mfn & FOREIGN_FRAME_BIT)) {
  888. ret = -EINVAL;
  889. goto out;
  890. }
  891. set_page_private(pages[i], INVALID_P2M_ENTRY);
  892. WARN_ON(!PagePrivate(pages[i]));
  893. ClearPagePrivate(pages[i]);
  894. set_phys_to_machine(pfn, pages[i]->index);
  895. if (kmap_ops)
  896. ret = m2p_remove_override(pages[i], &kmap_ops[i], mfn);
  897. if (ret)
  898. goto out;
  899. }
  900. out:
  901. if (lazy)
  902. arch_leave_lazy_mmu_mode();
  903. return ret;
  904. }
  905. EXPORT_SYMBOL_GPL(clear_foreign_p2m_mapping);
  906. int m2p_remove_override(struct page *page,
  907. struct gnttab_map_grant_ref *kmap_op,
  908. unsigned long mfn)
  909. {
  910. unsigned long flags;
  911. unsigned long pfn;
  912. unsigned long uninitialized_var(address);
  913. unsigned level;
  914. pte_t *ptep = NULL;
  915. pfn = page_to_pfn(page);
  916. if (!PageHighMem(page)) {
  917. address = (unsigned long)__va(pfn << PAGE_SHIFT);
  918. ptep = lookup_address(address, &level);
  919. if (WARN(ptep == NULL || level != PG_LEVEL_4K,
  920. "m2p_remove_override: pfn %lx not mapped", pfn))
  921. return -EINVAL;
  922. }
  923. spin_lock_irqsave(&m2p_override_lock, flags);
  924. list_del(&page->lru);
  925. spin_unlock_irqrestore(&m2p_override_lock, flags);
  926. if (kmap_op != NULL) {
  927. if (!PageHighMem(page)) {
  928. struct multicall_space mcs;
  929. struct gnttab_unmap_and_replace *unmap_op;
  930. struct page *scratch_page = get_balloon_scratch_page();
  931. unsigned long scratch_page_address = (unsigned long)
  932. __va(page_to_pfn(scratch_page) << PAGE_SHIFT);
  933. /*
  934. * It might be that we queued all the m2p grant table
  935. * hypercalls in a multicall, then m2p_remove_override
  936. * get called before the multicall has actually been
  937. * issued. In this case handle is going to -1 because
  938. * it hasn't been modified yet.
  939. */
  940. if (kmap_op->handle == -1)
  941. xen_mc_flush();
  942. /*
  943. * Now if kmap_op->handle is negative it means that the
  944. * hypercall actually returned an error.
  945. */
  946. if (kmap_op->handle == GNTST_general_error) {
  947. printk(KERN_WARNING "m2p_remove_override: "
  948. "pfn %lx mfn %lx, failed to modify kernel mappings",
  949. pfn, mfn);
  950. put_balloon_scratch_page();
  951. return -1;
  952. }
  953. xen_mc_batch();
  954. mcs = __xen_mc_entry(
  955. sizeof(struct gnttab_unmap_and_replace));
  956. unmap_op = mcs.args;
  957. unmap_op->host_addr = kmap_op->host_addr;
  958. unmap_op->new_addr = scratch_page_address;
  959. unmap_op->handle = kmap_op->handle;
  960. MULTI_grant_table_op(mcs.mc,
  961. GNTTABOP_unmap_and_replace, unmap_op, 1);
  962. mcs = __xen_mc_entry(0);
  963. MULTI_update_va_mapping(mcs.mc, scratch_page_address,
  964. pfn_pte(page_to_pfn(scratch_page),
  965. PAGE_KERNEL_RO), 0);
  966. xen_mc_issue(PARAVIRT_LAZY_MMU);
  967. kmap_op->host_addr = 0;
  968. put_balloon_scratch_page();
  969. }
  970. }
  971. /* p2m(m2p(mfn)) == FOREIGN_FRAME(mfn): the mfn is already present
  972. * somewhere in this domain, even before being added to the
  973. * m2p_override (see comment above in m2p_add_override).
  974. * If there are no other entries in the m2p_override corresponding
  975. * to this mfn, then remove the FOREIGN_FRAME_BIT from the p2m for
  976. * the original pfn (the one shared by the frontend): the backend
  977. * cannot do any IO on this page anymore because it has been
  978. * unshared. Removing the FOREIGN_FRAME_BIT from the p2m entry of
  979. * the original pfn causes mfn_to_pfn(mfn) to return the frontend
  980. * pfn again. */
  981. mfn &= ~FOREIGN_FRAME_BIT;
  982. pfn = mfn_to_pfn_no_overrides(mfn);
  983. if (get_phys_to_machine(pfn) == FOREIGN_FRAME(mfn) &&
  984. m2p_find_override(mfn) == NULL)
  985. set_phys_to_machine(pfn, mfn);
  986. return 0;
  987. }
  988. EXPORT_SYMBOL_GPL(m2p_remove_override);
  989. struct page *m2p_find_override(unsigned long mfn)
  990. {
  991. unsigned long flags;
  992. struct list_head *bucket = &m2p_overrides[mfn_hash(mfn)];
  993. struct page *p, *ret;
  994. ret = NULL;
  995. spin_lock_irqsave(&m2p_override_lock, flags);
  996. list_for_each_entry(p, bucket, lru) {
  997. if (page_private(p) == mfn) {
  998. ret = p;
  999. break;
  1000. }
  1001. }
  1002. spin_unlock_irqrestore(&m2p_override_lock, flags);
  1003. return ret;
  1004. }
  1005. unsigned long m2p_find_override_pfn(unsigned long mfn, unsigned long pfn)
  1006. {
  1007. struct page *p = m2p_find_override(mfn);
  1008. unsigned long ret = pfn;
  1009. if (p)
  1010. ret = page_to_pfn(p);
  1011. return ret;
  1012. }
  1013. EXPORT_SYMBOL_GPL(m2p_find_override_pfn);
  1014. #ifdef CONFIG_XEN_DEBUG_FS
  1015. #include <linux/debugfs.h>
  1016. #include "debugfs.h"
  1017. static int p2m_dump_show(struct seq_file *m, void *v)
  1018. {
  1019. static const char * const level_name[] = { "top", "middle",
  1020. "entry", "abnormal", "error"};
  1021. #define TYPE_IDENTITY 0
  1022. #define TYPE_MISSING 1
  1023. #define TYPE_PFN 2
  1024. #define TYPE_UNKNOWN 3
  1025. static const char * const type_name[] = {
  1026. [TYPE_IDENTITY] = "identity",
  1027. [TYPE_MISSING] = "missing",
  1028. [TYPE_PFN] = "pfn",
  1029. [TYPE_UNKNOWN] = "abnormal"};
  1030. unsigned long pfn, prev_pfn_type = 0, prev_pfn_level = 0;
  1031. unsigned int uninitialized_var(prev_level);
  1032. unsigned int uninitialized_var(prev_type);
  1033. if (!p2m_top)
  1034. return 0;
  1035. for (pfn = 0; pfn < MAX_DOMAIN_PAGES; pfn++) {
  1036. unsigned topidx = p2m_top_index(pfn);
  1037. unsigned mididx = p2m_mid_index(pfn);
  1038. unsigned idx = p2m_index(pfn);
  1039. unsigned lvl, type;
  1040. lvl = 4;
  1041. type = TYPE_UNKNOWN;
  1042. if (p2m_top[topidx] == p2m_mid_missing) {
  1043. lvl = 0; type = TYPE_MISSING;
  1044. } else if (p2m_top[topidx] == NULL) {
  1045. lvl = 0; type = TYPE_UNKNOWN;
  1046. } else if (p2m_top[topidx][mididx] == NULL) {
  1047. lvl = 1; type = TYPE_UNKNOWN;
  1048. } else if (p2m_top[topidx][mididx] == p2m_identity) {
  1049. lvl = 1; type = TYPE_IDENTITY;
  1050. } else if (p2m_top[topidx][mididx] == p2m_missing) {
  1051. lvl = 1; type = TYPE_MISSING;
  1052. } else if (p2m_top[topidx][mididx][idx] == 0) {
  1053. lvl = 2; type = TYPE_UNKNOWN;
  1054. } else if (p2m_top[topidx][mididx][idx] == IDENTITY_FRAME(pfn)) {
  1055. lvl = 2; type = TYPE_IDENTITY;
  1056. } else if (p2m_top[topidx][mididx][idx] == INVALID_P2M_ENTRY) {
  1057. lvl = 2; type = TYPE_MISSING;
  1058. } else if (p2m_top[topidx][mididx][idx] == pfn) {
  1059. lvl = 2; type = TYPE_PFN;
  1060. } else if (p2m_top[topidx][mididx][idx] != pfn) {
  1061. lvl = 2; type = TYPE_PFN;
  1062. }
  1063. if (pfn == 0) {
  1064. prev_level = lvl;
  1065. prev_type = type;
  1066. }
  1067. if (pfn == MAX_DOMAIN_PAGES-1) {
  1068. lvl = 3;
  1069. type = TYPE_UNKNOWN;
  1070. }
  1071. if (prev_type != type) {
  1072. seq_printf(m, " [0x%lx->0x%lx] %s\n",
  1073. prev_pfn_type, pfn, type_name[prev_type]);
  1074. prev_pfn_type = pfn;
  1075. prev_type = type;
  1076. }
  1077. if (prev_level != lvl) {
  1078. seq_printf(m, " [0x%lx->0x%lx] level %s\n",
  1079. prev_pfn_level, pfn, level_name[prev_level]);
  1080. prev_pfn_level = pfn;
  1081. prev_level = lvl;
  1082. }
  1083. }
  1084. return 0;
  1085. #undef TYPE_IDENTITY
  1086. #undef TYPE_MISSING
  1087. #undef TYPE_PFN
  1088. #undef TYPE_UNKNOWN
  1089. }
  1090. static int p2m_dump_open(struct inode *inode, struct file *filp)
  1091. {
  1092. return single_open(filp, p2m_dump_show, NULL);
  1093. }
  1094. static const struct file_operations p2m_dump_fops = {
  1095. .open = p2m_dump_open,
  1096. .read = seq_read,
  1097. .llseek = seq_lseek,
  1098. .release = single_release,
  1099. };
  1100. static struct dentry *d_mmu_debug;
  1101. static int __init xen_p2m_debugfs(void)
  1102. {
  1103. struct dentry *d_xen = xen_init_debugfs();
  1104. if (d_xen == NULL)
  1105. return -ENOMEM;
  1106. d_mmu_debug = debugfs_create_dir("mmu", d_xen);
  1107. debugfs_create_file("p2m", 0600, d_mmu_debug, NULL, &p2m_dump_fops);
  1108. return 0;
  1109. }
  1110. fs_initcall(xen_p2m_debugfs);
  1111. #endif /* CONFIG_XEN_DEBUG_FS */