2007-12-20 14:39:59 +07:00
|
|
|
/*
|
2014-10-08 15:54:50 +07:00
|
|
|
* CoProcessor (SPU/AFU) mm fault handler
|
2007-12-20 14:39:59 +07:00
|
|
|
*
|
|
|
|
* (C) Copyright IBM Deutschland Entwicklung GmbH 2007
|
|
|
|
*
|
|
|
|
* Author: Arnd Bergmann <arndb@de.ibm.com>
|
|
|
|
* Author: Jeremy Kerr <jk@ozlabs.org>
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or modify
|
|
|
|
* it under the terms of the GNU General Public License as published by
|
|
|
|
* the Free Software Foundation; either version 2, or (at your option)
|
|
|
|
* any later version.
|
|
|
|
*
|
|
|
|
* This program is distributed in the hope that it will be useful,
|
|
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
|
* GNU General Public License for more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU General Public License
|
|
|
|
* along with this program; if not, write to the Free Software
|
|
|
|
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
|
|
*/
|
|
|
|
#include <linux/sched.h>
|
|
|
|
#include <linux/mm.h>
|
2011-07-23 05:24:23 +07:00
|
|
|
#include <linux/export.h>
|
2014-10-08 15:54:50 +07:00
|
|
|
#include <asm/reg.h>
|
2014-10-08 15:54:51 +07:00
|
|
|
#include <asm/copro.h>
|
2014-10-08 15:54:52 +07:00
|
|
|
#include <asm/spu.h>
|
2014-10-08 15:55:00 +07:00
|
|
|
#include <misc/cxl.h>
|
2007-12-20 14:39:59 +07:00
|
|
|
|
|
|
|
/*
|
|
|
|
* This ought to be kept in sync with the powerpc specific do_page_fault
|
|
|
|
* function. Currently, there are a few corner cases that we haven't had
|
|
|
|
* to handle fortunately.
|
|
|
|
*/
|
2014-10-08 15:54:50 +07:00
|
|
|
int copro_handle_mm_fault(struct mm_struct *mm, unsigned long ea,
|
2007-12-20 14:39:59 +07:00
|
|
|
unsigned long dsisr, unsigned *flt)
|
|
|
|
{
|
|
|
|
struct vm_area_struct *vma;
|
|
|
|
unsigned long is_write;
|
|
|
|
int ret;
|
|
|
|
|
2009-02-17 07:44:14 +07:00
|
|
|
if (mm == NULL)
|
2007-12-20 14:39:59 +07:00
|
|
|
return -EFAULT;
|
2009-02-17 07:44:14 +07:00
|
|
|
|
|
|
|
if (mm->pgd == NULL)
|
2007-12-20 14:39:59 +07:00
|
|
|
return -EFAULT;
|
|
|
|
|
|
|
|
down_read(&mm->mmap_sem);
|
2009-02-17 07:44:14 +07:00
|
|
|
ret = -EFAULT;
|
2007-12-20 14:39:59 +07:00
|
|
|
vma = find_vma(mm, ea);
|
|
|
|
if (!vma)
|
2009-02-17 07:44:14 +07:00
|
|
|
goto out_unlock;
|
|
|
|
|
|
|
|
if (ea < vma->vm_start) {
|
|
|
|
if (!(vma->vm_flags & VM_GROWSDOWN))
|
|
|
|
goto out_unlock;
|
|
|
|
if (expand_stack(vma, ea))
|
|
|
|
goto out_unlock;
|
|
|
|
}
|
|
|
|
|
2014-10-08 15:54:50 +07:00
|
|
|
is_write = dsisr & DSISR_ISSTORE;
|
2007-12-20 14:39:59 +07:00
|
|
|
if (is_write) {
|
|
|
|
if (!(vma->vm_flags & VM_WRITE))
|
2009-02-17 07:44:14 +07:00
|
|
|
goto out_unlock;
|
2007-12-20 14:39:59 +07:00
|
|
|
} else {
|
2014-10-08 15:54:50 +07:00
|
|
|
if (dsisr & DSISR_PROTFAULT)
|
2009-02-17 07:44:14 +07:00
|
|
|
goto out_unlock;
|
2007-12-20 14:39:59 +07:00
|
|
|
if (!(vma->vm_flags & (VM_READ | VM_EXEC)))
|
2009-02-17 07:44:14 +07:00
|
|
|
goto out_unlock;
|
2007-12-20 14:39:59 +07:00
|
|
|
}
|
2009-02-17 07:44:14 +07:00
|
|
|
|
2007-12-20 14:39:59 +07:00
|
|
|
ret = 0;
|
2009-04-10 23:01:23 +07:00
|
|
|
*flt = handle_mm_fault(mm, vma, ea, is_write ? FAULT_FLAG_WRITE : 0);
|
2007-12-20 14:39:59 +07:00
|
|
|
if (unlikely(*flt & VM_FAULT_ERROR)) {
|
|
|
|
if (*flt & VM_FAULT_OOM) {
|
|
|
|
ret = -ENOMEM;
|
2009-02-17 07:44:14 +07:00
|
|
|
goto out_unlock;
|
2007-12-20 14:39:59 +07:00
|
|
|
} else if (*flt & VM_FAULT_SIGBUS) {
|
|
|
|
ret = -EFAULT;
|
2009-02-17 07:44:14 +07:00
|
|
|
goto out_unlock;
|
2007-12-20 14:39:59 +07:00
|
|
|
}
|
|
|
|
BUG();
|
|
|
|
}
|
2009-02-17 07:44:14 +07:00
|
|
|
|
2007-12-20 14:39:59 +07:00
|
|
|
if (*flt & VM_FAULT_MAJOR)
|
|
|
|
current->maj_flt++;
|
|
|
|
else
|
|
|
|
current->min_flt++;
|
|
|
|
|
2009-02-17 07:44:14 +07:00
|
|
|
out_unlock:
|
2007-12-20 14:39:59 +07:00
|
|
|
up_read(&mm->mmap_sem);
|
2009-02-17 07:44:14 +07:00
|
|
|
return ret;
|
2007-12-20 14:39:59 +07:00
|
|
|
}
|
2014-10-08 15:54:50 +07:00
|
|
|
EXPORT_SYMBOL_GPL(copro_handle_mm_fault);
|
2014-10-08 15:54:51 +07:00
|
|
|
|
|
|
|
int copro_calculate_slb(struct mm_struct *mm, u64 ea, struct copro_slb *slb)
|
|
|
|
{
|
|
|
|
u64 vsid;
|
|
|
|
int psize, ssize;
|
|
|
|
|
|
|
|
slb->esid = (ea & ESID_MASK) | SLB_ESID_V;
|
|
|
|
|
|
|
|
switch (REGION_ID(ea)) {
|
|
|
|
case USER_REGION_ID:
|
|
|
|
pr_devel("%s: 0x%llx -- USER_REGION_ID\n", __func__, ea);
|
|
|
|
psize = get_slice_psize(mm, ea);
|
|
|
|
ssize = user_segment_size(ea);
|
|
|
|
vsid = get_vsid(mm->context.id, ea, ssize);
|
|
|
|
break;
|
|
|
|
case VMALLOC_REGION_ID:
|
|
|
|
pr_devel("%s: 0x%llx -- VMALLOC_REGION_ID\n", __func__, ea);
|
|
|
|
if (ea < VMALLOC_END)
|
|
|
|
psize = mmu_vmalloc_psize;
|
|
|
|
else
|
|
|
|
psize = mmu_io_psize;
|
|
|
|
ssize = mmu_kernel_ssize;
|
|
|
|
vsid = get_kernel_vsid(ea, mmu_kernel_ssize);
|
|
|
|
break;
|
|
|
|
case KERNEL_REGION_ID:
|
|
|
|
pr_devel("%s: 0x%llx -- KERNEL_REGION_ID\n", __func__, ea);
|
|
|
|
psize = mmu_linear_psize;
|
|
|
|
ssize = mmu_kernel_ssize;
|
|
|
|
vsid = get_kernel_vsid(ea, mmu_kernel_ssize);
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
pr_debug("%s: invalid region access at %016llx\n", __func__, ea);
|
|
|
|
return 1;
|
|
|
|
}
|
|
|
|
|
|
|
|
vsid = (vsid << slb_vsid_shift(ssize)) | SLB_VSID_USER;
|
|
|
|
|
|
|
|
vsid |= mmu_psize_defs[psize].sllp |
|
|
|
|
((ssize == MMU_SEGSIZE_1T) ? SLB_VSID_B_1T : 0);
|
|
|
|
|
|
|
|
slb->vsid = vsid;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(copro_calculate_slb);
|
2014-10-08 15:54:52 +07:00
|
|
|
|
|
|
|
void copro_flush_all_slbs(struct mm_struct *mm)
|
|
|
|
{
|
|
|
|
#ifdef CONFIG_SPU_BASE
|
|
|
|
spu_flush_all_slbs(mm);
|
|
|
|
#endif
|
2014-10-08 15:55:00 +07:00
|
|
|
cxl_slbia(mm);
|
2014-10-08 15:54:52 +07:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(copro_flush_all_slbs);
|