1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23#include <linux/sched.h>
24#include <linux/mm.h>
25#include <linux/export.h>
26#include <asm/reg.h>
27#include <asm/copro.h>
28#include <asm/spu.h>
29#include <misc/cxl-base.h>
30
31
32
33
34
35
36int copro_handle_mm_fault(struct mm_struct *mm, unsigned long ea,
37 unsigned long dsisr, unsigned *flt)
38{
39 struct vm_area_struct *vma;
40 unsigned long is_write;
41 int ret;
42
43 if (mm == NULL)
44 return -EFAULT;
45
46 if (mm->pgd == NULL)
47 return -EFAULT;
48
49 down_read(&mm->mmap_sem);
50 ret = -EFAULT;
51 vma = find_vma(mm, ea);
52 if (!vma)
53 goto out_unlock;
54
55 if (ea < vma->vm_start) {
56 if (!(vma->vm_flags & VM_GROWSDOWN))
57 goto out_unlock;
58 if (expand_stack(vma, ea))
59 goto out_unlock;
60 }
61
62 is_write = dsisr & DSISR_ISSTORE;
63 if (is_write) {
64 if (!(vma->vm_flags & VM_WRITE))
65 goto out_unlock;
66 } else {
67 if (dsisr & DSISR_PROTFAULT)
68 goto out_unlock;
69 if (!(vma->vm_flags & (VM_READ | VM_EXEC)))
70 goto out_unlock;
71 }
72
73 ret = 0;
74 *flt = handle_mm_fault(mm, vma, ea, is_write ? FAULT_FLAG_WRITE : 0);
75 if (unlikely(*flt & VM_FAULT_ERROR)) {
76 if (*flt & VM_FAULT_OOM) {
77 ret = -ENOMEM;
78 goto out_unlock;
79 } else if (*flt & VM_FAULT_SIGBUS) {
80 ret = -EFAULT;
81 goto out_unlock;
82 }
83 BUG();
84 }
85
86 if (*flt & VM_FAULT_MAJOR)
87 current->maj_flt++;
88 else
89 current->min_flt++;
90
91out_unlock:
92 up_read(&mm->mmap_sem);
93 return ret;
94}
95EXPORT_SYMBOL_GPL(copro_handle_mm_fault);
96
97int copro_calculate_slb(struct mm_struct *mm, u64 ea, struct copro_slb *slb)
98{
99 u64 vsid, vsidkey;
100 int psize, ssize;
101
102 switch (REGION_ID(ea)) {
103 case USER_REGION_ID:
104 pr_devel("%s: 0x%llx -- USER_REGION_ID\n", __func__, ea);
105 if (mm == NULL)
106 return 1;
107 psize = get_slice_psize(mm, ea);
108 ssize = user_segment_size(ea);
109 vsid = get_vsid(mm->context.id, ea, ssize);
110 vsidkey = SLB_VSID_USER;
111 break;
112 case VMALLOC_REGION_ID:
113 pr_devel("%s: 0x%llx -- VMALLOC_REGION_ID\n", __func__, ea);
114 if (ea < VMALLOC_END)
115 psize = mmu_vmalloc_psize;
116 else
117 psize = mmu_io_psize;
118 ssize = mmu_kernel_ssize;
119 vsid = get_kernel_vsid(ea, mmu_kernel_ssize);
120 vsidkey = SLB_VSID_KERNEL;
121 break;
122 case KERNEL_REGION_ID:
123 pr_devel("%s: 0x%llx -- KERNEL_REGION_ID\n", __func__, ea);
124 psize = mmu_linear_psize;
125 ssize = mmu_kernel_ssize;
126 vsid = get_kernel_vsid(ea, mmu_kernel_ssize);
127 vsidkey = SLB_VSID_KERNEL;
128 break;
129 default:
130 pr_debug("%s: invalid region access at %016llx\n", __func__, ea);
131 return 1;
132 }
133
134 vsid = (vsid << slb_vsid_shift(ssize)) | vsidkey;
135
136 vsid |= mmu_psize_defs[psize].sllp |
137 ((ssize == MMU_SEGSIZE_1T) ? SLB_VSID_B_1T : 0);
138
139 slb->esid = (ea & (ssize == MMU_SEGSIZE_1T ? ESID_MASK_1T : ESID_MASK)) | SLB_ESID_V;
140 slb->vsid = vsid;
141
142 return 0;
143}
144EXPORT_SYMBOL_GPL(copro_calculate_slb);
145
146void copro_flush_all_slbs(struct mm_struct *mm)
147{
148#ifdef CONFIG_SPU_BASE
149 spu_flush_all_slbs(mm);
150#endif
151 cxl_slbia(mm);
152}
153EXPORT_SYMBOL_GPL(copro_flush_all_slbs);
154