18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 28c2ecf20Sopenharmony_ci 38c2ecf20Sopenharmony_ci#include <linux/pagemap.h> 48c2ecf20Sopenharmony_ci#include <linux/xarray.h> 58c2ecf20Sopenharmony_ci#include <linux/slab.h> 68c2ecf20Sopenharmony_ci#include <linux/swap.h> 78c2ecf20Sopenharmony_ci#include <linux/swapops.h> 88c2ecf20Sopenharmony_ci#include <asm/mte.h> 98c2ecf20Sopenharmony_ci 108c2ecf20Sopenharmony_cistatic DEFINE_XARRAY(mte_pages); 118c2ecf20Sopenharmony_ci 128c2ecf20Sopenharmony_civoid *mte_allocate_tag_storage(void) 138c2ecf20Sopenharmony_ci{ 148c2ecf20Sopenharmony_ci /* tags granule is 16 bytes, 2 tags stored per byte */ 158c2ecf20Sopenharmony_ci return kmalloc(PAGE_SIZE / 16 / 2, GFP_KERNEL); 168c2ecf20Sopenharmony_ci} 178c2ecf20Sopenharmony_ci 188c2ecf20Sopenharmony_civoid mte_free_tag_storage(char *storage) 198c2ecf20Sopenharmony_ci{ 208c2ecf20Sopenharmony_ci kfree(storage); 218c2ecf20Sopenharmony_ci} 228c2ecf20Sopenharmony_ci 238c2ecf20Sopenharmony_ciint mte_save_tags(struct page *page) 248c2ecf20Sopenharmony_ci{ 258c2ecf20Sopenharmony_ci void *tag_storage, *ret; 268c2ecf20Sopenharmony_ci 278c2ecf20Sopenharmony_ci if (!test_bit(PG_mte_tagged, &page->flags)) 288c2ecf20Sopenharmony_ci return 0; 298c2ecf20Sopenharmony_ci 308c2ecf20Sopenharmony_ci tag_storage = mte_allocate_tag_storage(); 318c2ecf20Sopenharmony_ci if (!tag_storage) 328c2ecf20Sopenharmony_ci return -ENOMEM; 338c2ecf20Sopenharmony_ci 348c2ecf20Sopenharmony_ci mte_save_page_tags(page_address(page), tag_storage); 358c2ecf20Sopenharmony_ci 368c2ecf20Sopenharmony_ci /* page_private contains the swap entry.val set in do_swap_page */ 378c2ecf20Sopenharmony_ci ret = xa_store(&mte_pages, page_private(page), tag_storage, GFP_KERNEL); 388c2ecf20Sopenharmony_ci if (WARN(xa_is_err(ret), "Failed to store MTE tags")) { 398c2ecf20Sopenharmony_ci mte_free_tag_storage(tag_storage); 408c2ecf20Sopenharmony_ci return xa_err(ret); 418c2ecf20Sopenharmony_ci } else if (ret) { 428c2ecf20Sopenharmony_ci /* Entry is being replaced, free the old entry */ 438c2ecf20Sopenharmony_ci mte_free_tag_storage(ret); 448c2ecf20Sopenharmony_ci } 458c2ecf20Sopenharmony_ci 468c2ecf20Sopenharmony_ci return 0; 478c2ecf20Sopenharmony_ci} 488c2ecf20Sopenharmony_ci 498c2ecf20Sopenharmony_cibool mte_restore_tags(swp_entry_t entry, struct page *page) 508c2ecf20Sopenharmony_ci{ 518c2ecf20Sopenharmony_ci void *tags = xa_load(&mte_pages, entry.val); 528c2ecf20Sopenharmony_ci 538c2ecf20Sopenharmony_ci if (!tags) 548c2ecf20Sopenharmony_ci return false; 558c2ecf20Sopenharmony_ci 568c2ecf20Sopenharmony_ci mte_restore_page_tags(page_address(page), tags); 578c2ecf20Sopenharmony_ci 588c2ecf20Sopenharmony_ci return true; 598c2ecf20Sopenharmony_ci} 608c2ecf20Sopenharmony_ci 618c2ecf20Sopenharmony_civoid mte_invalidate_tags(int type, pgoff_t offset) 628c2ecf20Sopenharmony_ci{ 638c2ecf20Sopenharmony_ci swp_entry_t entry = swp_entry(type, offset); 648c2ecf20Sopenharmony_ci void *tags = xa_erase(&mte_pages, entry.val); 658c2ecf20Sopenharmony_ci 668c2ecf20Sopenharmony_ci mte_free_tag_storage(tags); 678c2ecf20Sopenharmony_ci} 688c2ecf20Sopenharmony_ci 698c2ecf20Sopenharmony_civoid mte_invalidate_tags_area(int type) 708c2ecf20Sopenharmony_ci{ 718c2ecf20Sopenharmony_ci swp_entry_t entry = swp_entry(type, 0); 728c2ecf20Sopenharmony_ci swp_entry_t last_entry = swp_entry(type + 1, 0); 738c2ecf20Sopenharmony_ci void *tags; 748c2ecf20Sopenharmony_ci 758c2ecf20Sopenharmony_ci XA_STATE(xa_state, &mte_pages, entry.val); 768c2ecf20Sopenharmony_ci 778c2ecf20Sopenharmony_ci xa_lock(&mte_pages); 788c2ecf20Sopenharmony_ci xas_for_each(&xa_state, tags, last_entry.val - 1) { 798c2ecf20Sopenharmony_ci __xa_erase(&mte_pages, xa_state.xa_index); 808c2ecf20Sopenharmony_ci mte_free_tag_storage(tags); 818c2ecf20Sopenharmony_ci } 828c2ecf20Sopenharmony_ci xa_unlock(&mte_pages); 838c2ecf20Sopenharmony_ci} 84