arch/mips/kernel/spram.c

   1 /*
   2  * MIPS SPRAM support
   3  *
   4  * This program is free software; you can redistribute it and/or
   5  * modify it under the terms of the GNU General Public License
   6  * as published by the Free Software Foundation; either version
   7  * 2 of the License, or (at your option) any later version.
   8  *
   9  * Copyright (C) 2007, 2008 MIPS Technologies, Inc.
  10  */
  11 #include <linux/kernel.h>
  12 #include <linux/ptrace.h>
  13 #include <linux/stddef.h>
  14
  15 #include <asm/fpu.h>
  16 #include <asm/mipsregs.h>
  17 #include <asm/r4kcache.h>
  18 #include <asm/hazards.h>
  19
  20 /*
  21  * These definitions are correct for the 24K/34K/74K SPRAM sample
  22  * implementation. The 4KS interpreted the tags differently...
  23  */
  24 #define SPRAM_TAG0_ENABLE       0x00000080
  25 #define SPRAM_TAG0_PA_MASK      0xfffff000
  26 #define SPRAM_TAG1_SIZE_MASK    0xfffff000
  27
  28 #define SPRAM_TAG_STRIDE        8
  29
  30 #define ERRCTL_SPRAM            (1 << 28)
  31
  32 /* errctl access */
  33 #define read_c0_errctl(x) read_c0_ecc(x)
  34 #define write_c0_errctl(x) write_c0_ecc(x)
  35
  36 /*
  37  * Different semantics to the set_c0_* function built by __BUILD_SET_C0
  38  */
  39 static unsigned int bis_c0_errctl(unsigned int set)
  40 {
  41         unsigned int res;
  42         res = read_c0_errctl();
  43         write_c0_errctl(res | set);
  44         return res;
  45 }
  46
  47 static void ispram_store_tag(unsigned int offset, unsigned int data)
  48 {
  49         unsigned int errctl;
  50
  51         /* enable SPRAM tag access */
  52         errctl = bis_c0_errctl(ERRCTL_SPRAM);
  53         ehb();
  54
  55         write_c0_taglo(data);
  56         ehb();
  57
  58         cache_op(Index_Store_Tag_I, CKSEG0|offset);
  59         ehb();
  60
  61         write_c0_errctl(errctl);
  62         ehb();
  63 }
  64
  65
  66 static unsigned int ispram_load_tag(unsigned int offset)
  67 {
  68         unsigned int data;
  69         unsigned int errctl;
  70
  71         /* enable SPRAM tag access */
  72         errctl = bis_c0_errctl(ERRCTL_SPRAM);
  73         ehb();
  74         cache_op(Index_Load_Tag_I, CKSEG0 | offset);
  75         ehb();
  76         data = read_c0_taglo();
  77         ehb();
  78         write_c0_errctl(errctl);
  79         ehb();
  80
  81         return data;
  82 }
  83
  84 static void dspram_store_tag(unsigned int offset, unsigned int data)
  85 {
  86         unsigned int errctl;
  87
  88         /* enable SPRAM tag access */
  89         errctl = bis_c0_errctl(ERRCTL_SPRAM);
  90         ehb();
  91         write_c0_dtaglo(data);
  92         ehb();
  93         cache_op(Index_Store_Tag_D, CKSEG0 | offset);
  94         ehb();
  95         write_c0_errctl(errctl);
  96         ehb();
  97 }
  98
  99
 100 static unsigned int dspram_load_tag(unsigned int offset)
 101 {
 102         unsigned int data;
 103         unsigned int errctl;
 104
 105         errctl = bis_c0_errctl(ERRCTL_SPRAM);
 106         ehb();
 107         cache_op(Index_Load_Tag_D, CKSEG0 | offset);
 108         ehb();
 109         data = read_c0_dtaglo();
 110         ehb();
 111         write_c0_errctl(errctl);
 112         ehb();
 113
 114         return data;
 115 }
 116
 117 static void probe_spram(char *type,
 118             unsigned int base,
 119             unsigned int (*read)(unsigned int),
 120             void (*write)(unsigned int, unsigned int))
 121 {
 122         unsigned int firstsize = 0, lastsize = 0;
 123         unsigned int firstpa = 0, lastpa = 0, pa = 0;
 124         unsigned int offset = 0;
 125         unsigned int size, tag0, tag1;
 126         unsigned int enabled;
 127         int i;
 128
 129         /*
 130          * The limit is arbitrary but avoids the loop running away if
 131          * the SPRAM tags are implemented differently
 132          */
 133
 134         for (i = 0; i < 8; i++) {
 135                 tag0 = read(offset);
 136                 tag1 = read(offset+SPRAM_TAG_STRIDE);
 137                 pr_debug("DBG %s%d: tag0=%08x tag1=%08x\n",
 138                          type, i, tag0, tag1);
 139
 140                 size = tag1 & SPRAM_TAG1_SIZE_MASK;
 141
 142                 if (size == 0)
 143                         break;
 144
 145                 if (i != 0) {
 146                         /* tags may repeat... */
 147                         if ((pa == firstpa && size == firstsize) ||
 148                             (pa == lastpa && size == lastsize))
 149                                 break;
 150                 }
 151
 152                 /* Align base with size */
 153                 base = (base + size - 1) & ~(size-1);
 154
 155                 /* reprogram the base address base address and enable */
 156                 tag0 = (base & SPRAM_TAG0_PA_MASK) | SPRAM_TAG0_ENABLE;
 157                 write(offset, tag0);
 158
 159                 base += size;
 160
 161                 /* reread the tag */
 162                 tag0 = read(offset);
 163                 pa = tag0 & SPRAM_TAG0_PA_MASK;
 164                 enabled = tag0 & SPRAM_TAG0_ENABLE;
 165
 166                 if (i == 0) {
 167                         firstpa = pa;
 168                         firstsize = size;
 169                 }
 170
 171                 lastpa = pa;
 172                 lastsize = size;
 173
 174                 if (strcmp(type, "DSPRAM") == 0) {
 175                         unsigned int *vp = (unsigned int *)(CKSEG1 | pa);
 176                         unsigned int v;
 177 #define TDAT    0x5a5aa5a5
 178                         vp[0] = TDAT;
 179                         vp[1] = ~TDAT;
 180
 181                         mb();
 182
 183                         v = vp[0];
 184                         if (v != TDAT)
 185                                 printk(KERN_ERR "vp=%p wrote=%08x got=%08x\n",
 186                                        vp, TDAT, v);
 187                         v = vp[1];
 188                         if (v != ~TDAT)
 189                                 printk(KERN_ERR "vp=%p wrote=%08x got=%08x\n",
 190                                        vp+1, ~TDAT, v);
 191                 }
 192
 193                 pr_info("%s%d: PA=%08x,Size=%08x%s\n",
 194                         type, i, pa, size, enabled ? ",enabled" : "");
 195                 offset += 2 * SPRAM_TAG_STRIDE;
 196         }
 197 }
 198 void spram_config(void)
 199 {
 200         struct cpuinfo_mips *c = &current_cpu_data;
 201         unsigned int config0;
 202
 203         switch (c->cputype) {
 204         case CPU_24K:
 205         case CPU_34K:
 206         case CPU_74K:
 207         case CPU_1004K:
 208         case CPU_INTERAPTIV:
 209         case CPU_PROAPTIV:
 210                 config0 = read_c0_config();
 211                 /* FIXME: addresses are Malta specific */
 212                 if (config0 & (1<<24)) {
 213                         probe_spram("ISPRAM", 0x1c000000,
 214                                     &ispram_load_tag, &ispram_store_tag);
 215                 }
 216                 if (config0 & (1<<23))
 217                         probe_spram("DSPRAM", 0x1c100000,
 218                                     &dspram_load_tag, &dspram_store_tag);
 219         }
 220 }