162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * linux/arch/arm/mm/copypage-v6.c 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Copyright (C) 2002 Deep Blue Solutions Ltd, All Rights Reserved. 662306a36Sopenharmony_ci */ 762306a36Sopenharmony_ci#include <linux/init.h> 862306a36Sopenharmony_ci#include <linux/spinlock.h> 962306a36Sopenharmony_ci#include <linux/mm.h> 1062306a36Sopenharmony_ci#include <linux/highmem.h> 1162306a36Sopenharmony_ci#include <linux/pagemap.h> 1262306a36Sopenharmony_ci 1362306a36Sopenharmony_ci#include <asm/shmparam.h> 1462306a36Sopenharmony_ci#include <asm/tlbflush.h> 1562306a36Sopenharmony_ci#include <asm/cacheflush.h> 1662306a36Sopenharmony_ci#include <asm/cachetype.h> 1762306a36Sopenharmony_ci 1862306a36Sopenharmony_ci#include "mm.h" 1962306a36Sopenharmony_ci 2062306a36Sopenharmony_ci#if SHMLBA > 16384 2162306a36Sopenharmony_ci#error FIX ME 2262306a36Sopenharmony_ci#endif 2362306a36Sopenharmony_ci 2462306a36Sopenharmony_cistatic DEFINE_RAW_SPINLOCK(v6_lock); 2562306a36Sopenharmony_ci 2662306a36Sopenharmony_ci/* 2762306a36Sopenharmony_ci * Copy the user page. No aliasing to deal with so we can just 2862306a36Sopenharmony_ci * attack the kernel's existing mapping of these pages. 2962306a36Sopenharmony_ci */ 3062306a36Sopenharmony_cistatic void v6_copy_user_highpage_nonaliasing(struct page *to, 3162306a36Sopenharmony_ci struct page *from, unsigned long vaddr, struct vm_area_struct *vma) 3262306a36Sopenharmony_ci{ 3362306a36Sopenharmony_ci void *kto, *kfrom; 3462306a36Sopenharmony_ci 3562306a36Sopenharmony_ci kfrom = kmap_atomic(from); 3662306a36Sopenharmony_ci kto = kmap_atomic(to); 3762306a36Sopenharmony_ci copy_page(kto, kfrom); 3862306a36Sopenharmony_ci kunmap_atomic(kto); 3962306a36Sopenharmony_ci kunmap_atomic(kfrom); 4062306a36Sopenharmony_ci} 4162306a36Sopenharmony_ci 4262306a36Sopenharmony_ci/* 4362306a36Sopenharmony_ci * Clear the user page. No aliasing to deal with so we can just 4462306a36Sopenharmony_ci * attack the kernel's existing mapping of this page. 4562306a36Sopenharmony_ci */ 4662306a36Sopenharmony_cistatic void v6_clear_user_highpage_nonaliasing(struct page *page, unsigned long vaddr) 4762306a36Sopenharmony_ci{ 4862306a36Sopenharmony_ci void *kaddr = kmap_atomic(page); 4962306a36Sopenharmony_ci clear_page(kaddr); 5062306a36Sopenharmony_ci kunmap_atomic(kaddr); 5162306a36Sopenharmony_ci} 5262306a36Sopenharmony_ci 5362306a36Sopenharmony_ci/* 5462306a36Sopenharmony_ci * Discard data in the kernel mapping for the new page. 5562306a36Sopenharmony_ci * FIXME: needs this MCRR to be supported. 5662306a36Sopenharmony_ci */ 5762306a36Sopenharmony_cistatic void discard_old_kernel_data(void *kto) 5862306a36Sopenharmony_ci{ 5962306a36Sopenharmony_ci __asm__("mcrr p15, 0, %1, %0, c6 @ 0xec401f06" 6062306a36Sopenharmony_ci : 6162306a36Sopenharmony_ci : "r" (kto), 6262306a36Sopenharmony_ci "r" ((unsigned long)kto + PAGE_SIZE - 1) 6362306a36Sopenharmony_ci : "cc"); 6462306a36Sopenharmony_ci} 6562306a36Sopenharmony_ci 6662306a36Sopenharmony_ci/* 6762306a36Sopenharmony_ci * Copy the page, taking account of the cache colour. 6862306a36Sopenharmony_ci */ 6962306a36Sopenharmony_cistatic void v6_copy_user_highpage_aliasing(struct page *to, 7062306a36Sopenharmony_ci struct page *from, unsigned long vaddr, struct vm_area_struct *vma) 7162306a36Sopenharmony_ci{ 7262306a36Sopenharmony_ci struct folio *src = page_folio(from); 7362306a36Sopenharmony_ci unsigned int offset = CACHE_COLOUR(vaddr); 7462306a36Sopenharmony_ci unsigned long kfrom, kto; 7562306a36Sopenharmony_ci 7662306a36Sopenharmony_ci if (!test_and_set_bit(PG_dcache_clean, &src->flags)) 7762306a36Sopenharmony_ci __flush_dcache_folio(folio_flush_mapping(src), src); 7862306a36Sopenharmony_ci 7962306a36Sopenharmony_ci /* FIXME: not highmem safe */ 8062306a36Sopenharmony_ci discard_old_kernel_data(page_address(to)); 8162306a36Sopenharmony_ci 8262306a36Sopenharmony_ci /* 8362306a36Sopenharmony_ci * Now copy the page using the same cache colour as the 8462306a36Sopenharmony_ci * pages ultimate destination. 8562306a36Sopenharmony_ci */ 8662306a36Sopenharmony_ci raw_spin_lock(&v6_lock); 8762306a36Sopenharmony_ci 8862306a36Sopenharmony_ci kfrom = COPYPAGE_V6_FROM + (offset << PAGE_SHIFT); 8962306a36Sopenharmony_ci kto = COPYPAGE_V6_TO + (offset << PAGE_SHIFT); 9062306a36Sopenharmony_ci 9162306a36Sopenharmony_ci set_top_pte(kfrom, mk_pte(from, PAGE_KERNEL)); 9262306a36Sopenharmony_ci set_top_pte(kto, mk_pte(to, PAGE_KERNEL)); 9362306a36Sopenharmony_ci 9462306a36Sopenharmony_ci copy_page((void *)kto, (void *)kfrom); 9562306a36Sopenharmony_ci 9662306a36Sopenharmony_ci raw_spin_unlock(&v6_lock); 9762306a36Sopenharmony_ci} 9862306a36Sopenharmony_ci 9962306a36Sopenharmony_ci/* 10062306a36Sopenharmony_ci * Clear the user page. We need to deal with the aliasing issues, 10162306a36Sopenharmony_ci * so remap the kernel page into the same cache colour as the user 10262306a36Sopenharmony_ci * page. 10362306a36Sopenharmony_ci */ 10462306a36Sopenharmony_cistatic void v6_clear_user_highpage_aliasing(struct page *page, unsigned long vaddr) 10562306a36Sopenharmony_ci{ 10662306a36Sopenharmony_ci unsigned long to = COPYPAGE_V6_TO + (CACHE_COLOUR(vaddr) << PAGE_SHIFT); 10762306a36Sopenharmony_ci 10862306a36Sopenharmony_ci /* FIXME: not highmem safe */ 10962306a36Sopenharmony_ci discard_old_kernel_data(page_address(page)); 11062306a36Sopenharmony_ci 11162306a36Sopenharmony_ci /* 11262306a36Sopenharmony_ci * Now clear the page using the same cache colour as 11362306a36Sopenharmony_ci * the pages ultimate destination. 11462306a36Sopenharmony_ci */ 11562306a36Sopenharmony_ci raw_spin_lock(&v6_lock); 11662306a36Sopenharmony_ci 11762306a36Sopenharmony_ci set_top_pte(to, mk_pte(page, PAGE_KERNEL)); 11862306a36Sopenharmony_ci clear_page((void *)to); 11962306a36Sopenharmony_ci 12062306a36Sopenharmony_ci raw_spin_unlock(&v6_lock); 12162306a36Sopenharmony_ci} 12262306a36Sopenharmony_ci 12362306a36Sopenharmony_cistruct cpu_user_fns v6_user_fns __initdata = { 12462306a36Sopenharmony_ci .cpu_clear_user_highpage = v6_clear_user_highpage_nonaliasing, 12562306a36Sopenharmony_ci .cpu_copy_user_highpage = v6_copy_user_highpage_nonaliasing, 12662306a36Sopenharmony_ci}; 12762306a36Sopenharmony_ci 12862306a36Sopenharmony_cistatic int __init v6_userpage_init(void) 12962306a36Sopenharmony_ci{ 13062306a36Sopenharmony_ci if (cache_is_vipt_aliasing()) { 13162306a36Sopenharmony_ci cpu_user.cpu_clear_user_highpage = v6_clear_user_highpage_aliasing; 13262306a36Sopenharmony_ci cpu_user.cpu_copy_user_highpage = v6_copy_user_highpage_aliasing; 13362306a36Sopenharmony_ci } 13462306a36Sopenharmony_ci 13562306a36Sopenharmony_ci return 0; 13662306a36Sopenharmony_ci} 13762306a36Sopenharmony_ci 13862306a36Sopenharmony_cicore_initcall(v6_userpage_init); 139