18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * CoProcessor (SPU/AFU) mm fault handler
48c2ecf20Sopenharmony_ci *
58c2ecf20Sopenharmony_ci * (C) Copyright IBM Deutschland Entwicklung GmbH 2007
68c2ecf20Sopenharmony_ci *
78c2ecf20Sopenharmony_ci * Author: Arnd Bergmann <arndb@de.ibm.com>
88c2ecf20Sopenharmony_ci * Author: Jeremy Kerr <jk@ozlabs.org>
98c2ecf20Sopenharmony_ci */
108c2ecf20Sopenharmony_ci#include <linux/sched.h>
118c2ecf20Sopenharmony_ci#include <linux/mm.h>
128c2ecf20Sopenharmony_ci#include <linux/export.h>
138c2ecf20Sopenharmony_ci#include <asm/reg.h>
148c2ecf20Sopenharmony_ci#include <asm/copro.h>
158c2ecf20Sopenharmony_ci#include <asm/spu.h>
168c2ecf20Sopenharmony_ci#include <misc/cxl-base.h>
178c2ecf20Sopenharmony_ci
188c2ecf20Sopenharmony_ci/*
198c2ecf20Sopenharmony_ci * This ought to be kept in sync with the powerpc specific do_page_fault
208c2ecf20Sopenharmony_ci * function. Currently, there are a few corner cases that we haven't had
218c2ecf20Sopenharmony_ci * to handle fortunately.
228c2ecf20Sopenharmony_ci */
238c2ecf20Sopenharmony_ciint copro_handle_mm_fault(struct mm_struct *mm, unsigned long ea,
248c2ecf20Sopenharmony_ci		unsigned long dsisr, vm_fault_t *flt)
258c2ecf20Sopenharmony_ci{
268c2ecf20Sopenharmony_ci	struct vm_area_struct *vma;
278c2ecf20Sopenharmony_ci	unsigned long is_write;
288c2ecf20Sopenharmony_ci	int ret;
298c2ecf20Sopenharmony_ci
308c2ecf20Sopenharmony_ci	if (mm == NULL)
318c2ecf20Sopenharmony_ci		return -EFAULT;
328c2ecf20Sopenharmony_ci
338c2ecf20Sopenharmony_ci	if (mm->pgd == NULL)
348c2ecf20Sopenharmony_ci		return -EFAULT;
358c2ecf20Sopenharmony_ci
368c2ecf20Sopenharmony_ci	mmap_read_lock(mm);
378c2ecf20Sopenharmony_ci	ret = -EFAULT;
388c2ecf20Sopenharmony_ci	vma = find_vma(mm, ea);
398c2ecf20Sopenharmony_ci	if (!vma)
408c2ecf20Sopenharmony_ci		goto out_unlock;
418c2ecf20Sopenharmony_ci
428c2ecf20Sopenharmony_ci	if (ea < vma->vm_start) {
438c2ecf20Sopenharmony_ci		if (!(vma->vm_flags & VM_GROWSDOWN))
448c2ecf20Sopenharmony_ci			goto out_unlock;
458c2ecf20Sopenharmony_ci		if (expand_stack(vma, ea))
468c2ecf20Sopenharmony_ci			goto out_unlock;
478c2ecf20Sopenharmony_ci	}
488c2ecf20Sopenharmony_ci
498c2ecf20Sopenharmony_ci	is_write = dsisr & DSISR_ISSTORE;
508c2ecf20Sopenharmony_ci	if (is_write) {
518c2ecf20Sopenharmony_ci		if (!(vma->vm_flags & VM_WRITE))
528c2ecf20Sopenharmony_ci			goto out_unlock;
538c2ecf20Sopenharmony_ci	} else {
548c2ecf20Sopenharmony_ci		if (!(vma->vm_flags & (VM_READ | VM_EXEC)))
558c2ecf20Sopenharmony_ci			goto out_unlock;
568c2ecf20Sopenharmony_ci		/*
578c2ecf20Sopenharmony_ci		 * PROT_NONE is covered by the VMA check above.
588c2ecf20Sopenharmony_ci		 * and hash should get a NOHPTE fault instead of
598c2ecf20Sopenharmony_ci		 * a PROTFAULT in case fixup is needed for things
608c2ecf20Sopenharmony_ci		 * like autonuma.
618c2ecf20Sopenharmony_ci		 */
628c2ecf20Sopenharmony_ci		if (!radix_enabled())
638c2ecf20Sopenharmony_ci			WARN_ON_ONCE(dsisr & DSISR_PROTFAULT);
648c2ecf20Sopenharmony_ci	}
658c2ecf20Sopenharmony_ci
668c2ecf20Sopenharmony_ci	ret = 0;
678c2ecf20Sopenharmony_ci	*flt = handle_mm_fault(vma, ea, is_write ? FAULT_FLAG_WRITE : 0, NULL);
688c2ecf20Sopenharmony_ci	if (unlikely(*flt & VM_FAULT_ERROR)) {
698c2ecf20Sopenharmony_ci		if (*flt & VM_FAULT_OOM) {
708c2ecf20Sopenharmony_ci			ret = -ENOMEM;
718c2ecf20Sopenharmony_ci			goto out_unlock;
728c2ecf20Sopenharmony_ci		} else if (*flt & (VM_FAULT_SIGBUS | VM_FAULT_SIGSEGV)) {
738c2ecf20Sopenharmony_ci			ret = -EFAULT;
748c2ecf20Sopenharmony_ci			goto out_unlock;
758c2ecf20Sopenharmony_ci		}
768c2ecf20Sopenharmony_ci		BUG();
778c2ecf20Sopenharmony_ci	}
788c2ecf20Sopenharmony_ci
798c2ecf20Sopenharmony_ciout_unlock:
808c2ecf20Sopenharmony_ci	mmap_read_unlock(mm);
818c2ecf20Sopenharmony_ci	return ret;
828c2ecf20Sopenharmony_ci}
838c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(copro_handle_mm_fault);
848c2ecf20Sopenharmony_ci
858c2ecf20Sopenharmony_ciint copro_calculate_slb(struct mm_struct *mm, u64 ea, struct copro_slb *slb)
868c2ecf20Sopenharmony_ci{
878c2ecf20Sopenharmony_ci	u64 vsid, vsidkey;
888c2ecf20Sopenharmony_ci	int psize, ssize;
898c2ecf20Sopenharmony_ci
908c2ecf20Sopenharmony_ci	switch (get_region_id(ea)) {
918c2ecf20Sopenharmony_ci	case USER_REGION_ID:
928c2ecf20Sopenharmony_ci		pr_devel("%s: 0x%llx -- USER_REGION_ID\n", __func__, ea);
938c2ecf20Sopenharmony_ci		if (mm == NULL)
948c2ecf20Sopenharmony_ci			return 1;
958c2ecf20Sopenharmony_ci		psize = get_slice_psize(mm, ea);
968c2ecf20Sopenharmony_ci		ssize = user_segment_size(ea);
978c2ecf20Sopenharmony_ci		vsid = get_user_vsid(&mm->context, ea, ssize);
988c2ecf20Sopenharmony_ci		vsidkey = SLB_VSID_USER;
998c2ecf20Sopenharmony_ci		break;
1008c2ecf20Sopenharmony_ci	case VMALLOC_REGION_ID:
1018c2ecf20Sopenharmony_ci		pr_devel("%s: 0x%llx -- VMALLOC_REGION_ID\n", __func__, ea);
1028c2ecf20Sopenharmony_ci		psize = mmu_vmalloc_psize;
1038c2ecf20Sopenharmony_ci		ssize = mmu_kernel_ssize;
1048c2ecf20Sopenharmony_ci		vsid = get_kernel_vsid(ea, mmu_kernel_ssize);
1058c2ecf20Sopenharmony_ci		vsidkey = SLB_VSID_KERNEL;
1068c2ecf20Sopenharmony_ci		break;
1078c2ecf20Sopenharmony_ci	case IO_REGION_ID:
1088c2ecf20Sopenharmony_ci		pr_devel("%s: 0x%llx -- IO_REGION_ID\n", __func__, ea);
1098c2ecf20Sopenharmony_ci		psize = mmu_io_psize;
1108c2ecf20Sopenharmony_ci		ssize = mmu_kernel_ssize;
1118c2ecf20Sopenharmony_ci		vsid = get_kernel_vsid(ea, mmu_kernel_ssize);
1128c2ecf20Sopenharmony_ci		vsidkey = SLB_VSID_KERNEL;
1138c2ecf20Sopenharmony_ci		break;
1148c2ecf20Sopenharmony_ci	case LINEAR_MAP_REGION_ID:
1158c2ecf20Sopenharmony_ci		pr_devel("%s: 0x%llx -- LINEAR_MAP_REGION_ID\n", __func__, ea);
1168c2ecf20Sopenharmony_ci		psize = mmu_linear_psize;
1178c2ecf20Sopenharmony_ci		ssize = mmu_kernel_ssize;
1188c2ecf20Sopenharmony_ci		vsid = get_kernel_vsid(ea, mmu_kernel_ssize);
1198c2ecf20Sopenharmony_ci		vsidkey = SLB_VSID_KERNEL;
1208c2ecf20Sopenharmony_ci		break;
1218c2ecf20Sopenharmony_ci	default:
1228c2ecf20Sopenharmony_ci		pr_debug("%s: invalid region access at %016llx\n", __func__, ea);
1238c2ecf20Sopenharmony_ci		return 1;
1248c2ecf20Sopenharmony_ci	}
1258c2ecf20Sopenharmony_ci	/* Bad address */
1268c2ecf20Sopenharmony_ci	if (!vsid)
1278c2ecf20Sopenharmony_ci		return 1;
1288c2ecf20Sopenharmony_ci
1298c2ecf20Sopenharmony_ci	vsid = (vsid << slb_vsid_shift(ssize)) | vsidkey;
1308c2ecf20Sopenharmony_ci
1318c2ecf20Sopenharmony_ci	vsid |= mmu_psize_defs[psize].sllp |
1328c2ecf20Sopenharmony_ci		((ssize == MMU_SEGSIZE_1T) ? SLB_VSID_B_1T : 0);
1338c2ecf20Sopenharmony_ci
1348c2ecf20Sopenharmony_ci	slb->esid = (ea & (ssize == MMU_SEGSIZE_1T ? ESID_MASK_1T : ESID_MASK)) | SLB_ESID_V;
1358c2ecf20Sopenharmony_ci	slb->vsid = vsid;
1368c2ecf20Sopenharmony_ci
1378c2ecf20Sopenharmony_ci	return 0;
1388c2ecf20Sopenharmony_ci}
1398c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(copro_calculate_slb);
1408c2ecf20Sopenharmony_ci
1418c2ecf20Sopenharmony_civoid copro_flush_all_slbs(struct mm_struct *mm)
1428c2ecf20Sopenharmony_ci{
1438c2ecf20Sopenharmony_ci#ifdef CONFIG_SPU_BASE
1448c2ecf20Sopenharmony_ci	spu_flush_all_slbs(mm);
1458c2ecf20Sopenharmony_ci#endif
1468c2ecf20Sopenharmony_ci	cxl_slbia(mm);
1478c2ecf20Sopenharmony_ci}
1488c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(copro_flush_all_slbs);
149