283 lines
6.0 KiB
ArmAsm
283 lines
6.0 KiB
ArmAsm
|
/*
|
||
|
|
* viking.S: High speed Viking cache/mmu operations
|
||
|
|
*
|
||
|
|
* Copyright (C) 1997 Eddie C. Dost (ecd@skynet.be)
|
||
|
|
* Copyright (C) 1997,1998,1999 Jakub Jelinek (jj@ultra.linux.cz)
|
||
|
|
* Copyright (C) 1999 Pavel Semerad (semerad@ss1000.ms.mff.cuni.cz)
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <asm/ptrace.h>
|
||
|
|
#include <asm/psr.h>
|
||
|
|
#include <asm/asm-offsets.h>
|
||
|
|
#include <asm/asi.h>
|
||
|
|
#include <asm/mxcc.h>
|
||
|
|
#include <asm/page.h>
|
||
|
|
#include <asm/pgtsrmmu.h>
|
||
|
|
#include <asm/viking.h>
|
||
|
|
|
||
|
|
#ifdef CONFIG_SMP
|
||
|
|
.data
|
||
|
|
.align 4
|
||
|
|
sun4dsmp_flush_tlb_spin:
|
||
|
|
.word 0
|
||
|
|
#endif
|
||
|
|
|
||
|
|
.text
|
||
|
|
.align 4
|
||
|
|
|
||
|
|
.globl viking_flush_cache_all, viking_flush_cache_mm
|
||
|
|
.globl viking_flush_cache_range, viking_flush_cache_page
|
||
|
|
.globl viking_flush_page, viking_mxcc_flush_page
|
||
|
|
.globl viking_flush_page_for_dma, viking_flush_page_to_ram
|
||
|
|
.globl viking_flush_sig_insns
|
||
|
|
.globl viking_flush_tlb_all, viking_flush_tlb_mm
|
||
|
|
.globl viking_flush_tlb_range, viking_flush_tlb_page
|
||
|
|
|
||
|
|
viking_flush_page:
|
||
|
|
sethi %hi(PAGE_OFFSET), %g2
|
||
|
|
sub %o0, %g2, %g3
|
||
|
|
srl %g3, 12, %g1 ! ppage >> 12
|
||
|
|
|
||
|
|
clr %o1 ! set counter, 0 - 127
|
||
|
|
sethi %hi(PAGE_OFFSET + PAGE_SIZE - 0x80000000), %o3
|
||
|
|
sethi %hi(0x80000000), %o4
|
||
|
|
sethi %hi(VIKING_PTAG_VALID), %o5
|
||
|
|
sethi %hi(2*PAGE_SIZE), %o0
|
||
|
|
sethi %hi(PAGE_SIZE), %g7
|
||
|
|
clr %o2 ! block counter, 0 - 3
|
||
|
|
5:
|
||
|
|
sll %o1, 5, %g4
|
||
|
|
or %g4, %o4, %g4 ! 0x80000000 | (set << 5)
|
||
|
|
|
||
|
|
sll %o2, 26, %g5 ! block << 26
|
||
|
|
6:
|
||
|
|
or %g5, %g4, %g5
|
||
|
|
ldda [%g5] ASI_M_DATAC_TAG, %g2
|
||
|
|
cmp %g3, %g1 ! ptag == ppage?
|
||
|
|
bne 7f
|
||
|
|
inc %o2
|
||
|
|
|
||
|
|
andcc %g2, %o5, %g0 ! ptag VALID?
|
||
|
|
be 7f
|
||
|
|
add %g4, %o3, %g2 ! (PAGE_OFFSET + PAGE_SIZE) | (set << 5)
|
||
|
|
ld [%g2], %g3
|
||
|
|
ld [%g2 + %g7], %g3
|
||
|
|
add %g2, %o0, %g2
|
||
|
|
ld [%g2], %g3
|
||
|
|
ld [%g2 + %g7], %g3
|
||
|
|
add %g2, %o0, %g2
|
||
|
|
ld [%g2], %g3
|
||
|
|
ld [%g2 + %g7], %g3
|
||
|
|
add %g2, %o0, %g2
|
||
|
|
ld [%g2], %g3
|
||
|
|
b 8f
|
||
|
|
ld [%g2 + %g7], %g3
|
||
|
|
|
||
|
|
7:
|
||
|
|
cmp %o2, 3
|
||
|
|
ble 6b
|
||
|
|
sll %o2, 26, %g5 ! block << 26
|
||
|
|
|
||
|
|
8: inc %o1
|
||
|
|
cmp %o1, 0x7f
|
||
|
|
ble 5b
|
||
|
|
clr %o2
|
||
|
|
|
||
|
|
9: retl
|
||
|
|
nop
|
||
|
|
|
||
|
|
viking_mxcc_flush_page:
|
||
|
|
sethi %hi(PAGE_OFFSET), %g2
|
||
|
|
sub %o0, %g2, %g3
|
||
|
|
sub %g3, -PAGE_SIZE, %g3 ! ppage + PAGE_SIZE
|
||
|
|
sethi %hi(MXCC_SRCSTREAM), %o3 ! assume %hi(MXCC_SRCSTREAM) == %hi(MXCC_DESTSTREAM)
|
||
|
|
mov 0x10, %g2 ! set cacheable bit
|
||
|
|
or %o3, %lo(MXCC_SRCSTREAM), %o2
|
||
|
|
or %o3, %lo(MXCC_DESSTREAM), %o3
|
||
|
|
sub %g3, MXCC_STREAM_SIZE, %g3
|
||
|
|
6:
|
||
|
|
stda %g2, [%o2] ASI_M_MXCC
|
||
|
|
stda %g2, [%o3] ASI_M_MXCC
|
||
|
|
andncc %g3, PAGE_MASK, %g0
|
||
|
|
bne 6b
|
||
|
|
sub %g3, MXCC_STREAM_SIZE, %g3
|
||
|
|
|
||
|
|
9: retl
|
||
|
|
nop
|
||
|
|
|
||
|
|
viking_flush_cache_page:
|
||
|
|
viking_flush_cache_range:
|
||
|
|
#ifndef CONFIG_SMP
|
||
|
|
ld [%o0 + VMA_VM_MM], %o0
|
||
|
|
#endif
|
||
|
|
viking_flush_cache_mm:
|
||
|
|
#ifndef CONFIG_SMP
|
||
|
|
ld [%o0 + AOFF_mm_context], %g1
|
||
|
|
cmp %g1, -1
|
||
|
|
bne viking_flush_cache_all
|
||
|
|
nop
|
||
|
|
b,a viking_flush_cache_out
|
||
|
|
#endif
|
||
|
|
viking_flush_cache_all:
|
||
|
|
WINDOW_FLUSH(%g4, %g5)
|
||
|
|
viking_flush_cache_out:
|
||
|
|
retl
|
||
|
|
nop
|
||
|
|
|
||
|
|
viking_flush_tlb_all:
|
||
|
|
mov 0x400, %g1
|
||
|
|
retl
|
||
|
|
sta %g0, [%g1] ASI_M_FLUSH_PROBE
|
||
|
|
|
||
|
|
viking_flush_tlb_mm:
|
||
|
|
mov SRMMU_CTX_REG, %g1
|
||
|
|
ld [%o0 + AOFF_mm_context], %o1
|
||
|
|
lda [%g1] ASI_M_MMUREGS, %g5
|
||
|
|
#ifndef CONFIG_SMP
|
||
|
|
cmp %o1, -1
|
||
|
|
be 1f
|
||
|
|
#endif
|
||
|
|
mov 0x300, %g2
|
||
|
|
sta %o1, [%g1] ASI_M_MMUREGS
|
||
|
|
sta %g0, [%g2] ASI_M_FLUSH_PROBE
|
||
|
|
retl
|
||
|
|
sta %g5, [%g1] ASI_M_MMUREGS
|
||
|
|
#ifndef CONFIG_SMP
|
||
|
|
1: retl
|
||
|
|
nop
|
||
|
|
#endif
|
||
|
|
|
||
|
|
viking_flush_tlb_range:
|
||
|
|
ld [%o0 + VMA_VM_MM], %o0
|
||
|
|
mov SRMMU_CTX_REG, %g1
|
||
|
|
ld [%o0 + AOFF_mm_context], %o3
|
||
|
|
lda [%g1] ASI_M_MMUREGS, %g5
|
||
|
|
#ifndef CONFIG_SMP
|
||
|
|
cmp %o3, -1
|
||
|
|
be 2f
|
||
|
|
#endif
|
||
|
|
sethi %hi(~((1 << SRMMU_PGDIR_SHIFT) - 1)), %o4
|
||
|
|
sta %o3, [%g1] ASI_M_MMUREGS
|
||
|
|
and %o1, %o4, %o1
|
||
|
|
add %o1, 0x200, %o1
|
||
|
|
sta %g0, [%o1] ASI_M_FLUSH_PROBE
|
||
|
|
1: sub %o1, %o4, %o1
|
||
|
|
cmp %o1, %o2
|
||
|
|
blu,a 1b
|
||
|
|
sta %g0, [%o1] ASI_M_FLUSH_PROBE
|
||
|
|
retl
|
||
|
|
sta %g5, [%g1] ASI_M_MMUREGS
|
||
|
|
#ifndef CONFIG_SMP
|
||
|
|
2: retl
|
||
|
|
nop
|
||
|
|
#endif
|
||
|
|
|
||
|
|
viking_flush_tlb_page:
|
||
|
|
ld [%o0 + VMA_VM_MM], %o0
|
||
|
|
mov SRMMU_CTX_REG, %g1
|
||
|
|
ld [%o0 + AOFF_mm_context], %o3
|
||
|
|
lda [%g1] ASI_M_MMUREGS, %g5
|
||
|
|
#ifndef CONFIG_SMP
|
||
|
|
cmp %o3, -1
|
||
|
|
be 1f
|
||
|
|
#endif
|
||
|
|
and %o1, PAGE_MASK, %o1
|
||
|
|
sta %o3, [%g1] ASI_M_MMUREGS
|
||
|
|
sta %g0, [%o1] ASI_M_FLUSH_PROBE
|
||
|
|
retl
|
||
|
|
sta %g5, [%g1] ASI_M_MMUREGS
|
||
|
|
#ifndef CONFIG_SMP
|
||
|
|
1: retl
|
||
|
|
nop
|
||
|
|
#endif
|
||
|
|
|
||
|
|
viking_flush_page_to_ram:
|
||
|
|
viking_flush_page_for_dma:
|
||
|
|
viking_flush_sig_insns:
|
||
|
|
retl
|
||
|
|
nop
|
||
|
|
|
||
|
|
#ifdef CONFIG_SMP
|
||
|
|
.globl sun4dsmp_flush_tlb_all, sun4dsmp_flush_tlb_mm
|
||
|
|
.globl sun4dsmp_flush_tlb_range, sun4dsmp_flush_tlb_page
|
||
|
|
sun4dsmp_flush_tlb_all:
|
||
|
|
sethi %hi(sun4dsmp_flush_tlb_spin), %g3
|
||
|
|
1: ldstub [%g3 + %lo(sun4dsmp_flush_tlb_spin)], %g5
|
||
|
|
tst %g5
|
||
|
|
bne 2f
|
||
|
|
mov 0x400, %g1
|
||
|
|
sta %g0, [%g1] ASI_M_FLUSH_PROBE
|
||
|
|
retl
|
||
|
|
stb %g0, [%g3 + %lo(sun4dsmp_flush_tlb_spin)]
|
||
|
|
2: tst %g5
|
||
|
|
bne,a 2b
|
||
|
|
ldub [%g3 + %lo(sun4dsmp_flush_tlb_spin)], %g5
|
||
|
|
b,a 1b
|
||
|
|
|
||
|
|
sun4dsmp_flush_tlb_mm:
|
||
|
|
sethi %hi(sun4dsmp_flush_tlb_spin), %g3
|
||
|
|
1: ldstub [%g3 + %lo(sun4dsmp_flush_tlb_spin)], %g5
|
||
|
|
tst %g5
|
||
|
|
bne 2f
|
||
|
|
mov SRMMU_CTX_REG, %g1
|
||
|
|
ld [%o0 + AOFF_mm_context], %o1
|
||
|
|
lda [%g1] ASI_M_MMUREGS, %g5
|
||
|
|
mov 0x300, %g2
|
||
|
|
sta %o1, [%g1] ASI_M_MMUREGS
|
||
|
|
sta %g0, [%g2] ASI_M_FLUSH_PROBE
|
||
|
|
sta %g5, [%g1] ASI_M_MMUREGS
|
||
|
|
retl
|
||
|
|
stb %g0, [%g3 + %lo(sun4dsmp_flush_tlb_spin)]
|
||
|
|
2: tst %g5
|
||
|
|
bne,a 2b
|
||
|
|
ldub [%g3 + %lo(sun4dsmp_flush_tlb_spin)], %g5
|
||
|
|
b,a 1b
|
||
|
|
|
||
|
|
sun4dsmp_flush_tlb_range:
|
||
|
|
sethi %hi(sun4dsmp_flush_tlb_spin), %g3
|
||
|
|
1: ldstub [%g3 + %lo(sun4dsmp_flush_tlb_spin)], %g5
|
||
|
|
tst %g5
|
||
|
|
bne 3f
|
||
|
|
mov SRMMU_CTX_REG, %g1
|
||
|
|
ld [%o0 + VMA_VM_MM], %o0
|
||
|
|
ld [%o0 + AOFF_mm_context], %o3
|
||
|
|
lda [%g1] ASI_M_MMUREGS, %g5
|
||
|
|
sethi %hi(~((1 << SRMMU_PGDIR_SHIFT) - 1)), %o4
|
||
|
|
sta %o3, [%g1] ASI_M_MMUREGS
|
||
|
|
and %o1, %o4, %o1
|
||
|
|
add %o1, 0x200, %o1
|
||
|
|
sta %g0, [%o1] ASI_M_FLUSH_PROBE
|
||
|
|
2: sub %o1, %o4, %o1
|
||
|
|
cmp %o1, %o2
|
||
|
|
blu,a 2b
|
||
|
|
sta %g0, [%o1] ASI_M_FLUSH_PROBE
|
||
|
|
sta %g5, [%g1] ASI_M_MMUREGS
|
||
|
|
retl
|
||
|
|
stb %g0, [%g3 + %lo(sun4dsmp_flush_tlb_spin)]
|
||
|
|
3: tst %g5
|
||
|
|
bne,a 3b
|
||
|
|
ldub [%g3 + %lo(sun4dsmp_flush_tlb_spin)], %g5
|
||
|
|
b,a 1b
|
||
|
|
|
||
|
|
sun4dsmp_flush_tlb_page:
|
||
|
|
sethi %hi(sun4dsmp_flush_tlb_spin), %g3
|
||
|
|
1: ldstub [%g3 + %lo(sun4dsmp_flush_tlb_spin)], %g5
|
||
|
|
tst %g5
|
||
|
|
bne 2f
|
||
|
|
mov SRMMU_CTX_REG, %g1
|
||
|
|
ld [%o0 + VMA_VM_MM], %o0
|
||
|
|
ld [%o0 + AOFF_mm_context], %o3
|
||
|
|
lda [%g1] ASI_M_MMUREGS, %g5
|
||
|
|
and %o1, PAGE_MASK, %o1
|
||
|
|
sta %o3, [%g1] ASI_M_MMUREGS
|
||
|
|
sta %g0, [%o1] ASI_M_FLUSH_PROBE
|
||
|
|
sta %g5, [%g1] ASI_M_MMUREGS
|
||
|
|
retl
|
||
|
|
stb %g0, [%g3 + %lo(sun4dsmp_flush_tlb_spin)]
|
||
|
|
2: tst %g5
|
||
|
|
bne,a 2b
|
||
|
|
ldub [%g3 + %lo(sun4dsmp_flush_tlb_spin)], %g5
|
||
|
|
b,a 1b
|
||
|
|
nop
|
||
|
|
#endif
|