| /* $Id: tsunami.S,v 1.7 2001/12/21 04:56:15 davem Exp $ |
| * tsunami.S: High speed MicroSparc-I mmu/cache operations. |
| * |
| * Copyright (C) 1997 David S. Miller (davem@caip.rutgers.edu) |
| */ |
| |
| #include <asm/ptrace.h> |
| #include <asm/asm-offsets.h> |
| #include <asm/psr.h> |
| #include <asm/asi.h> |
| #include <asm/page.h> |
| #include <asm/pgtsrmmu.h> |
| |
| .text |
| .align 4 |
| |
| .globl tsunami_flush_cache_all, tsunami_flush_cache_mm |
| .globl tsunami_flush_cache_range, tsunami_flush_cache_page |
| .globl tsunami_flush_page_to_ram, tsunami_flush_page_for_dma |
| .globl tsunami_flush_sig_insns |
| .globl tsunami_flush_tlb_all, tsunami_flush_tlb_mm |
| .globl tsunami_flush_tlb_range, tsunami_flush_tlb_page |
| |
| /* Sliiick... */ |
| tsunami_flush_cache_page: |
| tsunami_flush_cache_range: |
| ld [%o0 + 0x0], %o0 /* XXX vma->vm_mm, GROSS XXX */ |
| tsunami_flush_cache_mm: |
| ld [%o0 + AOFF_mm_context], %g2 |
| cmp %g2, -1 |
| be tsunami_flush_cache_out |
| tsunami_flush_cache_all: |
| WINDOW_FLUSH(%g4, %g5) |
| tsunami_flush_page_for_dma: |
| sta %g0, [%g0] ASI_M_IC_FLCLEAR |
| sta %g0, [%g0] ASI_M_DC_FLCLEAR |
| tsunami_flush_cache_out: |
| tsunami_flush_page_to_ram: |
| retl |
| nop |
| |
| tsunami_flush_sig_insns: |
| flush %o1 |
| retl |
| flush %o1 + 4 |
| |
| /* More slick stuff... */ |
| tsunami_flush_tlb_range: |
| ld [%o0 + 0x00], %o0 /* XXX vma->vm_mm GROSS XXX */ |
| tsunami_flush_tlb_mm: |
| ld [%o0 + AOFF_mm_context], %g2 |
| cmp %g2, -1 |
| be tsunami_flush_tlb_out |
| tsunami_flush_tlb_all: |
| mov 0x400, %o1 |
| sta %g0, [%o1] ASI_M_FLUSH_PROBE |
| nop |
| nop |
| nop |
| nop |
| nop |
| tsunami_flush_tlb_out: |
| retl |
| nop |
| |
| /* This one can be done in a fine grained manner... */ |
| tsunami_flush_tlb_page: |
| ld [%o0 + 0x00], %o0 /* XXX vma->vm_mm GROSS XXX */ |
| mov SRMMU_CTX_REG, %g1 |
| ld [%o0 + AOFF_mm_context], %o3 |
| andn %o1, (PAGE_SIZE - 1), %o1 |
| cmp %o3, -1 |
| be tsunami_flush_tlb_page_out |
| lda [%g1] ASI_M_MMUREGS, %g5 |
| sta %o3, [%g1] ASI_M_MMUREGS |
| sta %g0, [%o1] ASI_M_FLUSH_PROBE |
| nop |
| nop |
| nop |
| nop |
| nop |
| tsunami_flush_tlb_page_out: |
| retl |
| sta %g5, [%g1] ASI_M_MMUREGS |
| |
| #define MIRROR_BLOCK(dst, src, offset, t0, t1, t2, t3) \ |
| ldd [src + offset + 0x18], t0; \ |
| std t0, [dst + offset + 0x18]; \ |
| ldd [src + offset + 0x10], t2; \ |
| std t2, [dst + offset + 0x10]; \ |
| ldd [src + offset + 0x08], t0; \ |
| std t0, [dst + offset + 0x08]; \ |
| ldd [src + offset + 0x00], t2; \ |
| std t2, [dst + offset + 0x00]; |
| |
| .globl tsunami_copy_1page |
| tsunami_copy_1page: |
| /* NOTE: This routine has to be shorter than 70insns --jj */ |
| or %g0, (PAGE_SIZE >> 8), %g1 |
| 1: |
| MIRROR_BLOCK(%o0, %o1, 0x00, %o2, %o3, %o4, %o5) |
| MIRROR_BLOCK(%o0, %o1, 0x20, %o2, %o3, %o4, %o5) |
| MIRROR_BLOCK(%o0, %o1, 0x40, %o2, %o3, %o4, %o5) |
| MIRROR_BLOCK(%o0, %o1, 0x60, %o2, %o3, %o4, %o5) |
| MIRROR_BLOCK(%o0, %o1, 0x80, %o2, %o3, %o4, %o5) |
| MIRROR_BLOCK(%o0, %o1, 0xa0, %o2, %o3, %o4, %o5) |
| MIRROR_BLOCK(%o0, %o1, 0xc0, %o2, %o3, %o4, %o5) |
| MIRROR_BLOCK(%o0, %o1, 0xe0, %o2, %o3, %o4, %o5) |
| subcc %g1, 1, %g1 |
| add %o0, 0x100, %o0 |
| bne 1b |
| add %o1, 0x100, %o1 |
| |
| .globl tsunami_setup_blockops |
| tsunami_setup_blockops: |
| sethi %hi(__copy_1page), %o0 |
| or %o0, %lo(__copy_1page), %o0 |
| sethi %hi(tsunami_copy_1page), %o1 |
| or %o1, %lo(tsunami_copy_1page), %o1 |
| sethi %hi(tsunami_setup_blockops), %o2 |
| or %o2, %lo(tsunami_setup_blockops), %o2 |
| ld [%o1], %o4 |
| 1: add %o1, 4, %o1 |
| st %o4, [%o0] |
| add %o0, 4, %o0 |
| cmp %o1, %o2 |
| bne 1b |
| ld [%o1], %o4 |
| sta %g0, [%g0] ASI_M_IC_FLCLEAR |
| sta %g0, [%g0] ASI_M_DC_FLCLEAR |
| retl |
| nop |