[SPARC]: Fix initialization of sun4d SBUS interrupts.
[linux-2.6] / arch / sparc / mm / tsunami.S
1 /* $Id: tsunami.S,v 1.7 2001/12/21 04:56:15 davem Exp $
2  * tsunami.S: High speed MicroSparc-I mmu/cache operations.
3  *
4  * Copyright (C) 1997 David S. Miller (davem@caip.rutgers.edu)
5  */
6
7 #include <asm/ptrace.h>
8 #include <asm/asm-offsets.h>
9 #include <asm/psr.h>
10 #include <asm/asi.h>
11 #include <asm/page.h>
12 #include <asm/pgtsrmmu.h>
13
14         .text
15         .align  4
16
17         .globl  tsunami_flush_cache_all, tsunami_flush_cache_mm
18         .globl  tsunami_flush_cache_range, tsunami_flush_cache_page
19         .globl  tsunami_flush_page_to_ram, tsunami_flush_page_for_dma
20         .globl  tsunami_flush_sig_insns
21         .globl  tsunami_flush_tlb_all, tsunami_flush_tlb_mm
22         .globl  tsunami_flush_tlb_range, tsunami_flush_tlb_page
23
24         /* Sliiick... */
25 tsunami_flush_cache_page:
26 tsunami_flush_cache_range:
27         ld      [%o0 + 0x0], %o0        /* XXX vma->vm_mm, GROSS XXX */
28 tsunami_flush_cache_mm:
29         ld      [%o0 + AOFF_mm_context], %g2
30         cmp     %g2, -1
31         be      tsunami_flush_cache_out
32 tsunami_flush_cache_all:
33         WINDOW_FLUSH(%g4, %g5)
34 tsunami_flush_page_for_dma:
35         sta     %g0, [%g0] ASI_M_IC_FLCLEAR
36         sta     %g0, [%g0] ASI_M_DC_FLCLEAR
37 tsunami_flush_cache_out:
38 tsunami_flush_page_to_ram:
39         retl
40          nop
41
42 tsunami_flush_sig_insns:
43         flush   %o1
44         retl
45          flush  %o1 + 4
46
47         /* More slick stuff... */
48 tsunami_flush_tlb_range:
49         ld      [%o0 + 0x00], %o0       /* XXX vma->vm_mm GROSS XXX */
50 tsunami_flush_tlb_mm:
51         ld      [%o0 + AOFF_mm_context], %g2
52         cmp     %g2, -1
53         be      tsunami_flush_tlb_out
54 tsunami_flush_tlb_all:
55          mov    0x400, %o1
56         sta     %g0, [%o1] ASI_M_FLUSH_PROBE
57         nop
58         nop
59         nop
60         nop
61         nop
62 tsunami_flush_tlb_out:
63         retl
64          nop
65
66         /* This one can be done in a fine grained manner... */
67 tsunami_flush_tlb_page:
68         ld      [%o0 + 0x00], %o0       /* XXX vma->vm_mm GROSS XXX */
69         mov     SRMMU_CTX_REG, %g1
70         ld      [%o0 + AOFF_mm_context], %o3
71         andn    %o1, (PAGE_SIZE - 1), %o1
72         cmp     %o3, -1
73         be      tsunami_flush_tlb_page_out
74          lda    [%g1] ASI_M_MMUREGS, %g5
75         sta     %o3, [%g1] ASI_M_MMUREGS
76         sta     %g0, [%o1] ASI_M_FLUSH_PROBE
77         nop
78         nop
79         nop
80         nop
81         nop
82 tsunami_flush_tlb_page_out:
83         retl
84          sta    %g5, [%g1] ASI_M_MMUREGS
85
86 #define MIRROR_BLOCK(dst, src, offset, t0, t1, t2, t3) \
87         ldd     [src + offset + 0x18], t0; \
88         std     t0, [dst + offset + 0x18]; \
89         ldd     [src + offset + 0x10], t2; \
90         std     t2, [dst + offset + 0x10]; \
91         ldd     [src + offset + 0x08], t0; \
92         std     t0, [dst + offset + 0x08]; \
93         ldd     [src + offset + 0x00], t2; \
94         std     t2, [dst + offset + 0x00];
95
96         .globl  tsunami_copy_1page
97 tsunami_copy_1page:
98 /* NOTE: This routine has to be shorter than 70insns --jj */
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