arch/sh/mm/tlb-sh5.c

   1 /*
   2  * arch/sh/mm/tlb-sh5.c
   3  *
   4  * Copyright (C) 2003  Paul Mundt <lethal@linux-sh.org>
   5  * Copyright (C) 2003  Richard Curnow <richard.curnow@superh.com>
   6  *
   7  * This file is subject to the terms and conditions of the GNU General Public
   8  * License.  See the file "COPYING" in the main directory of this archive
   9  * for more details.
  10  */
  11 #include <linux/mm.h>
  12 #include <linux/init.h>
  13 #include <asm/page.h>
  14 #include <asm/tlb.h>
  15 #include <asm/mmu_context.h>
  16
  17 /**
  18  * sh64_tlb_init - Perform initial setup for the DTLB and ITLB.
  19  */
  20 int __init sh64_tlb_init(void)
  21 {
  22         /* Assign some sane DTLB defaults */
  23         cpu_data->dtlb.entries  = 64;
  24         cpu_data->dtlb.step     = 0x10;
  25
  26         cpu_data->dtlb.first    = DTLB_FIXED | cpu_data->dtlb.step;
  27         cpu_data->dtlb.next     = cpu_data->dtlb.first;
  28
  29         cpu_data->dtlb.last     = DTLB_FIXED |
  30                                   ((cpu_data->dtlb.entries - 1) *
  31                                    cpu_data->dtlb.step);
  32
  33         /* And again for the ITLB */
  34         cpu_data->itlb.entries  = 64;
  35         cpu_data->itlb.step     = 0x10;
  36
  37         cpu_data->itlb.first    = ITLB_FIXED | cpu_data->itlb.step;
  38         cpu_data->itlb.next     = cpu_data->itlb.first;
  39         cpu_data->itlb.last     = ITLB_FIXED |
  40                                   ((cpu_data->itlb.entries - 1) *
  41                                    cpu_data->itlb.step);
  42
  43         return 0;
  44 }
  45
  46 /**
  47  * sh64_next_free_dtlb_entry - Find the next available DTLB entry
  48  */
  49 unsigned long long sh64_next_free_dtlb_entry(void)
  50 {
  51         return cpu_data->dtlb.next;
  52 }
  53
  54 /**
  55  * sh64_get_wired_dtlb_entry - Allocate a wired (locked-in) entry in the DTLB
  56  */
  57 unsigned long long sh64_get_wired_dtlb_entry(void)
  58 {
  59         unsigned long long entry = sh64_next_free_dtlb_entry();
  60
  61         cpu_data->dtlb.first += cpu_data->dtlb.step;
  62         cpu_data->dtlb.next  += cpu_data->dtlb.step;
  63
  64         return entry;
  65 }
  66
  67 /**
  68  * sh64_put_wired_dtlb_entry - Free a wired (locked-in) entry in the DTLB.
  69  *
  70  * @entry:      Address of TLB slot.
  71  *
  72  * Works like a stack, last one to allocate must be first one to free.
  73  */
  74 int sh64_put_wired_dtlb_entry(unsigned long long entry)
  75 {
  76         __flush_tlb_slot(entry);
  77
  78         /*
  79          * We don't do any particularly useful tracking of wired entries,
  80          * so this approach works like a stack .. last one to be allocated
  81          * has to be the first one to be freed.
  82          *
  83          * We could potentially load wired entries into a list and work on
  84          * rebalancing the list periodically (which also entails moving the
  85          * contents of a TLB entry) .. though I have a feeling that this is
  86          * more trouble than it's worth.
  87          */
  88
  89         /*
  90          * Entry must be valid .. we don't want any ITLB addresses!
  91          */
  92         if (entry <= DTLB_FIXED)
  93                 return -EINVAL;
  94
  95         /*
  96          * Next, check if we're within range to be freed. (ie, must be the
  97          * entry beneath the first 'free' entry!
  98          */
  99         if (entry < (cpu_data->dtlb.first - cpu_data->dtlb.step))
 100                 return -EINVAL;
 101
 102         /* If we are, then bring this entry back into the list */
 103         cpu_data->dtlb.first    -= cpu_data->dtlb.step;
 104         cpu_data->dtlb.next     = entry;
 105
 106         return 0;
 107 }
 108
 109 /**
 110  * sh64_setup_tlb_slot - Load up a translation in a wired slot.
 111  *
 112  * @config_addr:        Address of TLB slot.
 113  * @eaddr:              Virtual address.
 114  * @asid:               Address Space Identifier.
 115  * @paddr:              Physical address.
 116  *
 117  * Load up a virtual<->physical translation for @eaddr<->@paddr in the
 118  * pre-allocated TLB slot @config_addr (see sh64_get_wired_dtlb_entry).
 119  */
 120 inline void sh64_setup_tlb_slot(unsigned long long config_addr,
 121                                 unsigned long eaddr,
 122                                 unsigned long asid,
 123                                 unsigned long paddr)
 124 {
 125         unsigned long long pteh, ptel;
 126
 127         /* Sign extension */
 128 #if (NEFF == 32)
 129         pteh = (unsigned long long)(signed long long)(signed long) eaddr;
 130 #else
 131 #error "Can't sign extend more than 32 bits yet"
 132 #endif
 133         pteh &= PAGE_MASK;
 134         pteh |= (asid << PTEH_ASID_SHIFT) | PTEH_VALID;
 135 #if (NEFF == 32)
 136         ptel = (unsigned long long)(signed long long)(signed long) paddr;
 137 #else
 138 #error "Can't sign extend more than 32 bits yet"
 139 #endif
 140         ptel &= PAGE_MASK;
 141         ptel |= (_PAGE_CACHABLE | _PAGE_READ | _PAGE_WRITE);
 142
 143         asm volatile("putcfg %0, 1, %1\n\t"
 144                         "putcfg %0, 0, %2\n"
 145                         : : "r" (config_addr), "r" (ptel), "r" (pteh));
 146 }
 147
 148 /**
 149  * sh64_teardown_tlb_slot - Teardown a translation.
 150  *
 151  * @config_addr:        Address of TLB slot.
 152  *
 153  * Teardown any existing mapping in the TLB slot @config_addr.
 154  */
 155 inline void sh64_teardown_tlb_slot(unsigned long long config_addr)
 156         __attribute__ ((alias("__flush_tlb_slot")));