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