1
2
3
4
5
6
7
8 #include <asm/ptrace.h>
9 #include <asm/asm-offsets.h>
10 #include <asm/psr.h>
11 #include <asm/asi.h>
12 #include <asm/page.h>
13 #include <asm/pgtsrmmu.h>
14
15 .text
16 .align 4
17
18 .globl tsunami_flush_cache_all, tsunami_flush_cache_mm
19 .globl tsunami_flush_cache_range, tsunami_flush_cache_page
20 .globl tsunami_flush_page_to_ram, tsunami_flush_page_for_dma
21 .globl tsunami_flush_sig_insns
22 .globl tsunami_flush_tlb_all, tsunami_flush_tlb_mm
23 .globl tsunami_flush_tlb_range, tsunami_flush_tlb_page
24
25
26 tsunami_flush_cache_page:
27 tsunami_flush_cache_range:
28 ld [%o0 + VMA_VM_MM], %o0
29 tsunami_flush_cache_mm:
30 ld [%o0 + AOFF_mm_context], %g2
31 cmp %g2, -1
32 be tsunami_flush_cache_out
33 tsunami_flush_cache_all:
34 WINDOW_FLUSH(%g4, %g5)
35 tsunami_flush_page_for_dma:
36 sta %g0, [%g0] ASI_M_IC_FLCLEAR
37 sta %g0, [%g0] ASI_M_DC_FLCLEAR
38 tsunami_flush_cache_out:
39 tsunami_flush_page_to_ram:
40 retl
41 nop
42
43 tsunami_flush_sig_insns:
44 flush %o1
45 retl
46 flush %o1 + 4
47
48
49 tsunami_flush_tlb_range:
50 ld [%o0 + VMA_VM_MM], %o0
51 tsunami_flush_tlb_mm:
52 ld [%o0 + AOFF_mm_context], %g2
53 cmp %g2, -1
54 be tsunami_flush_tlb_out
55 tsunami_flush_tlb_all:
56 mov 0x400, %o1
57 sta %g0, [%o1] ASI_M_FLUSH_PROBE
58 nop
59 nop
60 nop
61 nop
62 nop
63 tsunami_flush_tlb_out:
64 retl
65 nop
66
67
68 tsunami_flush_tlb_page:
69 ld [%o0 + VMA_VM_MM], %o0
70 mov SRMMU_CTX_REG, %g1
71 ld [%o0 + AOFF_mm_context], %o3
72 andn %o1, (PAGE_SIZE - 1), %o1
73 cmp %o3, -1
74 be tsunami_flush_tlb_page_out
75 lda [%g1] ASI_M_MMUREGS, %g5
76 sta %o3, [%g1] ASI_M_MMUREGS
77 sta %g0, [%o1] ASI_M_FLUSH_PROBE
78 nop
79 nop
80 nop
81 nop
82 nop
83 tsunami_flush_tlb_page_out:
84 retl
85 sta %g5, [%g1] ASI_M_MMUREGS
86
87 #define MIRROR_BLOCK(dst, src, offset, t0, t1, t2, t3) \
88 ldd [src + offset + 0x18], t0; \
89 std t0, [dst + offset + 0x18]; \
90 ldd [src + offset + 0x10], t2; \
91 std t2, [dst + offset + 0x10]; \
92 ldd [src + offset + 0x08], t0; \
93 std t0, [dst + offset + 0x08]; \
94 ldd [src + offset + 0x00], t2; \
95 std t2, [dst + offset + 0x00];
96
97 tsunami_copy_1page:
98
99 or %g0, (PAGE_SIZE >> 8), %g1
100 1:
101 MIRROR_BLOCK(%o0, %o1, 0x00, %o2, %o3, %o4, %o5)
102 MIRROR_BLOCK(%o0, %o1, 0x20, %o2, %o3, %o4, %o5)
103 MIRROR_BLOCK(%o0, %o1, 0x40, %o2, %o3, %o4, %o5)
104 MIRROR_BLOCK(%o0, %o1, 0x60, %o2, %o3, %o4, %o5)
105 MIRROR_BLOCK(%o0, %o1, 0x80, %o2, %o3, %o4, %o5)
106 MIRROR_BLOCK(%o0, %o1, 0xa0, %o2, %o3, %o4, %o5)
107 MIRROR_BLOCK(%o0, %o1, 0xc0, %o2, %o3, %o4, %o5)
108 MIRROR_BLOCK(%o0, %o1, 0xe0, %o2, %o3, %o4, %o5)
109 subcc %g1, 1, %g1
110 add %o0, 0x100, %o0
111 bne 1b
112 add %o1, 0x100, %o1
113
114 .globl tsunami_setup_blockops
115 tsunami_setup_blockops:
116 sethi %hi(__copy_1page), %o0
117 or %o0, %lo(__copy_1page), %o0
118 sethi %hi(tsunami_copy_1page), %o1
119 or %o1, %lo(tsunami_copy_1page), %o1
120 sethi %hi(tsunami_setup_blockops), %o2
121 or %o2, %lo(tsunami_setup_blockops), %o2
122 ld [%o1], %o4
123 1: add %o1, 4, %o1
124 st %o4, [%o0]
125 add %o0, 4, %o0
126 cmp %o1, %o2
127 bne 1b
128 ld [%o1], %o4
129 sta %g0, [%g0] ASI_M_IC_FLCLEAR
130 sta %g0, [%g0] ASI_M_DC_FLCLEAR
131 retl
132 nop