1
2
3
4
5
6
7#include "flexcop.h"
8
9static void flexcop_sram_set_chip(struct flexcop_device *fc,
10 flexcop_sram_type_t type)
11{
12 flexcop_set_ibi_value(wan_ctrl_reg_71c, sram_chip, type);
13}
14
15int flexcop_sram_init(struct flexcop_device *fc)
16{
17 switch (fc->rev) {
18 case FLEXCOP_II:
19 case FLEXCOP_IIB:
20 flexcop_sram_set_chip(fc, FC_SRAM_1_32KB);
21 break;
22 case FLEXCOP_III:
23 flexcop_sram_set_chip(fc, FC_SRAM_1_48KB);
24 break;
25 default:
26 return -EINVAL;
27 }
28 return 0;
29}
30
31int flexcop_sram_set_dest(struct flexcop_device *fc, flexcop_sram_dest_t dest,
32 flexcop_sram_dest_target_t target)
33{
34 flexcop_ibi_value v;
35 v = fc->read_ibi_reg(fc, sram_dest_reg_714);
36
37 if (fc->rev != FLEXCOP_III && target == FC_SRAM_DEST_TARGET_FC3_CA) {
38 err("SRAM destination target to available on FlexCopII(b)\n");
39 return -EINVAL;
40 }
41 deb_sram("sram dest: %x target: %x\n", dest, target);
42
43 if (dest & FC_SRAM_DEST_NET)
44 v.sram_dest_reg_714.NET_Dest = target;
45 if (dest & FC_SRAM_DEST_CAI)
46 v.sram_dest_reg_714.CAI_Dest = target;
47 if (dest & FC_SRAM_DEST_CAO)
48 v.sram_dest_reg_714.CAO_Dest = target;
49 if (dest & FC_SRAM_DEST_MEDIA)
50 v.sram_dest_reg_714.MEDIA_Dest = target;
51
52 fc->write_ibi_reg(fc,sram_dest_reg_714,v);
53 udelay(1000);
54
55 return 0;
56}
57EXPORT_SYMBOL(flexcop_sram_set_dest);
58
59void flexcop_wan_set_speed(struct flexcop_device *fc, flexcop_wan_speed_t s)
60{
61 flexcop_set_ibi_value(wan_ctrl_reg_71c,wan_speed_sig,s);
62}
63EXPORT_SYMBOL(flexcop_wan_set_speed);
64
65void flexcop_sram_ctrl(struct flexcop_device *fc, int usb_wan, int sramdma, int maximumfill)
66{
67 flexcop_ibi_value v = fc->read_ibi_reg(fc,sram_dest_reg_714);
68 v.sram_dest_reg_714.ctrl_usb_wan = usb_wan;
69 v.sram_dest_reg_714.ctrl_sramdma = sramdma;
70 v.sram_dest_reg_714.ctrl_maximumfill = maximumfill;
71 fc->write_ibi_reg(fc,sram_dest_reg_714,v);
72}
73EXPORT_SYMBOL(flexcop_sram_ctrl);
74
75#if 0
76static void flexcop_sram_write(struct adapter *adapter, u32 bank, u32 addr, u8 *buf, u32 len)
77{
78 int i, retries;
79 u32 command;
80
81 for (i = 0; i < len; i++) {
82 command = bank | addr | 0x04000000 | (*buf << 0x10);
83
84 retries = 2;
85
86 while (((read_reg_dw(adapter, 0x700) & 0x80000000) != 0) && (retries > 0)) {
87 mdelay(1);
88 retries--;
89 }
90
91 if (retries == 0)
92 printk("%s: SRAM timeout\n", __func__);
93
94 write_reg_dw(adapter, 0x700, command);
95
96 buf++;
97 addr++;
98 }
99}
100
101static void flex_sram_read(struct adapter *adapter, u32 bank, u32 addr, u8 *buf, u32 len)
102{
103 int i, retries;
104 u32 command, value;
105
106 for (i = 0; i < len; i++) {
107 command = bank | addr | 0x04008000;
108
109 retries = 10000;
110
111 while (((read_reg_dw(adapter, 0x700) & 0x80000000) != 0) && (retries > 0)) {
112 mdelay(1);
113 retries--;
114 }
115
116 if (retries == 0)
117 printk("%s: SRAM timeout\n", __func__);
118
119 write_reg_dw(adapter, 0x700, command);
120
121 retries = 10000;
122
123 while (((read_reg_dw(adapter, 0x700) & 0x80000000) != 0) && (retries > 0)) {
124 mdelay(1);
125 retries--;
126 }
127
128 if (retries == 0)
129 printk("%s: SRAM timeout\n", __func__);
130
131 value = read_reg_dw(adapter, 0x700) >> 0x10;
132
133 *buf = (value & 0xff);
134
135 addr++;
136 buf++;
137 }
138}
139
140static void sram_write_chunk(struct adapter *adapter, u32 addr, u8 *buf, u16 len)
141{
142 u32 bank;
143
144 bank = 0;
145
146 if (adapter->dw_sram_type == 0x20000) {
147 bank = (addr & 0x18000) << 0x0d;
148 }
149
150 if (adapter->dw_sram_type == 0x00000) {
151 if ((addr >> 0x0f) == 0)
152 bank = 0x20000000;
153 else
154 bank = 0x10000000;
155 }
156 flex_sram_write(adapter, bank, addr & 0x7fff, buf, len);
157}
158
159static void sram_read_chunk(struct adapter *adapter, u32 addr, u8 *buf, u16 len)
160{
161 u32 bank;
162 bank = 0;
163
164 if (adapter->dw_sram_type == 0x20000) {
165 bank = (addr & 0x18000) << 0x0d;
166 }
167
168 if (adapter->dw_sram_type == 0x00000) {
169 if ((addr >> 0x0f) == 0)
170 bank = 0x20000000;
171 else
172 bank = 0x10000000;
173 }
174 flex_sram_read(adapter, bank, addr & 0x7fff, buf, len);
175}
176
177static void sram_read(struct adapter *adapter, u32 addr, u8 *buf, u32 len)
178{
179 u32 length;
180 while (len != 0) {
181 length = len;
182
183
184
185 if ((addr >> 0x0f) != ((addr + len - 1) >> 0x0f)) {
186 length = (((addr >> 0x0f) + 1) << 0x0f) - addr;
187 }
188
189 sram_read_chunk(adapter, addr, buf, length);
190 addr = addr + length;
191 buf = buf + length;
192 len = len - length;
193 }
194}
195
196static void sram_write(struct adapter *adapter, u32 addr, u8 *buf, u32 len)
197{
198 u32 length;
199 while (len != 0) {
200 length = len;
201
202
203
204
205 if ((addr >> 0x0f) != ((addr + len - 1) >> 0x0f)) {
206 length = (((addr >> 0x0f) + 1) << 0x0f) - addr;
207 }
208
209 sram_write_chunk(adapter, addr, buf, length);
210 addr = addr + length;
211 buf = buf + length;
212 len = len - length;
213 }
214}
215
216static void sram_set_size(struct adapter *adapter, u32 mask)
217{
218 write_reg_dw(adapter, 0x71c,
219 (mask | (~0x30000 & read_reg_dw(adapter, 0x71c))));
220}
221
222static void sram_init(struct adapter *adapter)
223{
224 u32 tmp;
225 tmp = read_reg_dw(adapter, 0x71c);
226 write_reg_dw(adapter, 0x71c, 1);
227
228 if (read_reg_dw(adapter, 0x71c) != 0) {
229 write_reg_dw(adapter, 0x71c, tmp);
230 adapter->dw_sram_type = tmp & 0x30000;
231 ddprintk("%s: dw_sram_type = %x\n", __func__, adapter->dw_sram_type);
232 } else {
233 adapter->dw_sram_type = 0x10000;
234 ddprintk("%s: dw_sram_type = %x\n", __func__, adapter->dw_sram_type);
235 }
236}
237
238static int sram_test_location(struct adapter *adapter, u32 mask, u32 addr)
239{
240 u8 tmp1, tmp2;
241 dprintk("%s: mask = %x, addr = %x\n", __func__, mask, addr);
242
243 sram_set_size(adapter, mask);
244 sram_init(adapter);
245
246 tmp2 = 0xa5;
247 tmp1 = 0x4f;
248
249 sram_write(adapter, addr, &tmp2, 1);
250 sram_write(adapter, addr + 4, &tmp1, 1);
251
252 tmp2 = 0;
253 mdelay(20);
254
255 sram_read(adapter, addr, &tmp2, 1);
256 sram_read(adapter, addr, &tmp2, 1);
257
258 dprintk("%s: wrote 0xa5, read 0x%2x\n", __func__, tmp2);
259
260 if (tmp2 != 0xa5)
261 return 0;
262
263 tmp2 = 0x5a;
264 tmp1 = 0xf4;
265
266 sram_write(adapter, addr, &tmp2, 1);
267 sram_write(adapter, addr + 4, &tmp1, 1);
268
269 tmp2 = 0;
270 mdelay(20);
271
272 sram_read(adapter, addr, &tmp2, 1);
273 sram_read(adapter, addr, &tmp2, 1);
274
275 dprintk("%s: wrote 0x5a, read 0x%2x\n", __func__, tmp2);
276
277 if (tmp2 != 0x5a)
278 return 0;
279 return 1;
280}
281
282static u32 sram_length(struct adapter *adapter)
283{
284 if (adapter->dw_sram_type == 0x10000)
285 return 32768;
286 if (adapter->dw_sram_type == 0x00000)
287 return 65536;
288 if (adapter->dw_sram_type == 0x20000)
289 return 131072;
290 return 32768;
291}
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306static int flexcop_sram_detect(struct flexcop_device *fc)
307{
308 flexcop_ibi_value r208, r71c_0, vr71c_1;
309 r208 = fc->read_ibi_reg(fc, ctrl_208);
310 fc->write_ibi_reg(fc, ctrl_208, ibi_zero);
311
312 r71c_0 = fc->read_ibi_reg(fc, wan_ctrl_reg_71c);
313 write_reg_dw(adapter, 0x71c, 1);
314 tmp3 = read_reg_dw(adapter, 0x71c);
315 dprintk("%s: tmp3 = %x\n", __func__, tmp3);
316 write_reg_dw(adapter, 0x71c, tmp2);
317
318
319 tmp3--;
320 if (tmp3 != 0) {
321 sram_set_size(adapter, 0x10000);
322 sram_init(adapter);
323 write_reg_dw(adapter, 0x208, tmp);
324 dprintk("%s: sram size = 32K\n", __func__);
325 return 32;
326 }
327
328 if (sram_test_location(adapter, 0x20000, 0x18000) != 0) {
329 sram_set_size(adapter, 0x20000);
330 sram_init(adapter);
331 write_reg_dw(adapter, 0x208, tmp);
332 dprintk("%s: sram size = 128K\n", __func__);
333 return 128;
334 }
335
336 if (sram_test_location(adapter, 0x00000, 0x10000) != 0) {
337 sram_set_size(adapter, 0x00000);
338 sram_init(adapter);
339 write_reg_dw(adapter, 0x208, tmp);
340 dprintk("%s: sram size = 64K\n", __func__);
341 return 64;
342 }
343
344 if (sram_test_location(adapter, 0x10000, 0x00000) != 0) {
345 sram_set_size(adapter, 0x10000);
346 sram_init(adapter);
347 write_reg_dw(adapter, 0x208, tmp);
348 dprintk("%s: sram size = 32K\n", __func__);
349 return 32;
350 }
351
352 sram_set_size(adapter, 0x10000);
353 sram_init(adapter);
354 write_reg_dw(adapter, 0x208, tmp);
355 dprintk("%s: SRAM detection failed. Set to 32K \n", __func__);
356 return 0;
357}
358
359static void sll_detect_sram_size(struct adapter *adapter)
360{
361 sram_detect_for_flex2(adapter);
362}
363
364#endif
365
