| /* $Id: viking.S,v 1.19 2001/12/21 04:56:15 davem Exp $ |
| * 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> |
| #include <asm/btfixup.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 + 0x0], %o0 /* XXX vma->vm_mm, GROSS XXX */ |
| #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 + 0x00], %o0 /* XXX vma->vm_mm GROSS XXX */ |
| 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 + 0x00], %o0 /* XXX vma->vm_mm GROSS XXX */ |
| 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 + 0x00], %o0 /* XXX vma->vm_mm GROSS XXX */ |
| 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 + 0x00], %o0 /* XXX vma->vm_mm GROSS XXX */ |
| 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 |