]>
git.ipfire.org Git - people/ms/u-boot.git/blob - board/spc1920/hpi.c
3 * Markus Klotzbuecher, DENX Software Engineering, mk@denx.de.
5 * See file CREDITS for list of people who contributed to this
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License as
10 * published by the Free Software Foundation; either version 2 of
11 * the License, or (at your option) any later version.
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
25 * Host Port Interface (HPI)
44 #define _NOT_USED_ 0xFFFFFFFF
47 * - inserted loops to achieve long CS low and high Periods (~217ns)
48 * - move cs high 2/4 to the right
50 const uint dsp_table_slow
[] =
52 /* single read (offset 0x00 in upm ram) */
53 0x8fffdc04, 0x0fffdc84, 0x0fffdc84, 0x0fffdc00,
54 0x3fffdc04, 0xffffdc84, 0xffffdc84, 0xffffdc05,
56 /* burst read (offset 0x08 in upm ram) */
57 _NOT_USED_
, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
58 _NOT_USED_
, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
59 _NOT_USED_
, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
60 _NOT_USED_
, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
62 /* single write (offset 0x18 in upm ram) */
63 0x8fffd004, 0x0fffd084, 0x0fffd084, 0x3fffd000,
64 0xffffd084, 0xffffd084, 0xffffd005, _NOT_USED_
,
66 /* burst write (offset 0x20 in upm ram) */
67 _NOT_USED_
, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
68 _NOT_USED_
, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
69 _NOT_USED_
, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
70 _NOT_USED_
, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
71 /* refresh (offset 0x30 in upm ram) */
72 _NOT_USED_
, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
73 _NOT_USED_
, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
74 _NOT_USED_
, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
75 /* exception (offset 0x3C in upm ram) */
76 _NOT_USED_
, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
79 /* dsp hpi upm ram table
80 * works fine for noninc access, failes on incremental.
81 * - removed first word
83 const uint dsp_table_fast
[] =
85 /* single read (offset 0x00 in upm ram) */
86 0x8fffdc04, 0x0fffdc04, 0x0fffdc00, 0x3fffdc04,
87 0xffffdc05, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
89 /* burst read (offset 0x08 in upm ram) */
90 _NOT_USED_
, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
91 _NOT_USED_
, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
92 _NOT_USED_
, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
93 _NOT_USED_
, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
95 /* single write (offset 0x18 in upm ram) */
96 0x8fffd004, 0x0fffd004, 0x3fffd000, 0xffffd005,
97 _NOT_USED_
, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
99 /* burst write (offset 0x20 in upm ram) */
100 _NOT_USED_
, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
101 _NOT_USED_
, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
102 _NOT_USED_
, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
103 _NOT_USED_
, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
104 /* refresh (offset 0x30 in upm ram) */
105 _NOT_USED_
, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
106 _NOT_USED_
, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
107 _NOT_USED_
, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
108 /* exception (offset 0x3C in upm ram) */
109 _NOT_USED_
, _NOT_USED_
, _NOT_USED_
, _NOT_USED_
,
113 #ifdef CONFIG_SPC1920_HPI_TEST
116 #define HPI_TEST_CHUNKSIZE 0x1000
117 #define HPI_TEST_PATTERN 0x00000000
118 #define HPI_TEST_START 0x0
119 #define HPI_TEST_END 0x30000
121 #define TINY_AUTOINC_DATA_SIZE 16 /* 32bit words */
122 #define TINY_AUTOINC_BASE_ADDR 0x0
124 static int hpi_activate(void);
125 static void hpi_inactivate(void);
126 static void dsp_reset(void);
128 static int hpi_write_inc(u32 addr
, u32
*data
, u32 count
);
129 static int hpi_read_inc(u32 addr
, u32
*buf
, u32 count
);
130 static int hpi_write_noinc(u32 addr
, u32 data
);
131 static u32
hpi_read_noinc(u32 addr
);
134 static int hpi_write_addr_test(u32 addr
);
135 static int hpi_read_write_test(u32 addr
, u32 data
);
136 static int hpi_tiny_autoinc_test(void);
137 #endif /* CONFIG_SPC1920_HPI_TEST */
140 /* init the host port interface on UPMA */
143 volatile immap_t
*immr
= (immap_t
*) CFG_IMMR
;
144 volatile memctl8xx_t
*memctl
= &immr
->im_memctl
;
145 volatile spc1920_pld_t
*pld
= (spc1920_pld_t
*) CFG_SPC1920_PLD_BASE
;
147 upmconfig(UPMA
, (uint
*)dsp_table_slow
, sizeof(dsp_table_slow
)/sizeof(uint
));
150 memctl
->memc_mamr
= CFG_MAMR
;
151 memctl
->memc_or3
= CFG_OR3
;
152 memctl
->memc_br3
= CFG_BR3
;
157 /* activate hpi switch*/
158 pld
->dsp_hpi_on
= 0x1;
165 #ifdef CONFIG_SPC1920_HPI_TEST
166 /* activate the Host Port interface */
167 static int hpi_activate(void)
169 volatile spc1920_pld_t
*pld
= (spc1920_pld_t
*) CFG_SPC1920_PLD_BASE
;
172 pld
->dsp_hpi_on
= 0x1;
176 /* turn on the power EN_DSP_POWER high*/
177 /* currently always on TBD */
179 /* setup hpi control register */
180 HPI_HPIC_1
= (u16
) 0x0008;
181 HPI_HPIC_2
= (u16
) 0x0008;
188 /* turn off the host port interface */
189 static void hpi_inactivate(void)
191 volatile spc1920_pld_t
*pld
= (spc1920_pld_t
*) CFG_SPC1920_PLD_BASE
;
194 pld
->dsp_hpi_on
= 0x0;
197 /* pld->dsp_reset = 0x0; */
199 /* turn off the power EN_DSP_POWER# high*/
200 /* currently always on TBD */
205 static void dsp_reset(void)
207 volatile spc1920_pld_t
*pld
= (spc1920_pld_t
*) CFG_SPC1920_PLD_BASE
;
208 pld
->dsp_reset
= 0x1;
209 pld
->dsp_hpi_on
= 0x0;
213 pld
->dsp_reset
= 0x0;
214 pld
->dsp_hpi_on
= 0x1;
218 /* write using autoinc (count is number of 32bit words) */
219 static int hpi_write_inc(u32 addr
, u32
*data
, u32 count
)
224 addr1
= (u16
) ((addr
>> 16) & 0xffff); /* First HW is most significant */
225 addr2
= (u16
) (addr
& 0xffff);
231 debugX(4, "writing from data=0x%x to 0x%x\n", data
, (data
+count
));
233 for(i
=0; i
<count
; i
++) {
234 HPI_HPID_INC_1
= (u16
) ((data
[i
] >> 16) & 0xffff);
235 HPI_HPID_INC_2
= (u16
) (data
[i
] & 0xffff);
236 debugX(4, "hpi_write_inc: data1=0x%x, data2=0x%x\n",
237 (u16
) ((data
[i
] >> 16) & 0xffff),
238 (u16
) (data
[i
] & 0xffff));
241 while(data_ptr
< (u16
*) (data
+ count
)) {
242 HPI_HPID_INC_1
= *(data_ptr
++);
243 HPI_HPID_INC_2
= *(data_ptr
++);
247 /* return number of bytes written */
252 * read using autoinc (count is number of 32bit words)
254 static int hpi_read_inc(u32 addr
, u32
*buf
, u32 count
)
257 u16 addr1
, addr2
, data1
, data2
;
259 addr1
= (u16
) ((addr
>> 16) & 0xffff); /* First HW is most significant */
260 addr2
= (u16
) (addr
& 0xffff);
266 for(i
=0; i
<count
; i
++) {
267 data1
= HPI_HPID_INC_1
;
268 data2
= HPI_HPID_INC_2
;
269 debugX(4, "hpi_read_inc: data1=0x%x, data2=0x%x\n", data1
, data2
);
270 buf
[i
] = (((u32
) data1
) << 16) | (data2
& 0xffff);
274 while(buf_ptr
< (u16
*) (buf
+ count
)) {
275 *(buf_ptr
++) = HPI_HPID_INC_1
;
276 *(buf_ptr
++) = HPI_HPID_INC_2
;
280 /* return number of bytes read */
285 /* write to non- auto inc regs */
286 static int hpi_write_noinc(u32 addr
, u32 data
)
289 u16 addr1
, addr2
, data1
, data2
;
291 addr1
= (u16
) ((addr
>> 16) & 0xffff); /* First HW is most significant */
292 addr2
= (u16
) (addr
& 0xffff);
294 /* printf("hpi_write_noinc: addr1=0x%x, addr2=0x%x\n", addr1, addr2); */
299 data1
= (u16
) ((data
>> 16) & 0xffff);
300 data2
= (u16
) (data
& 0xffff);
302 /* printf("hpi_write_noinc: data1=0x%x, data2=0x%x\n", data1, data2); */
304 HPI_HPID_NOINC_1
= data1
;
305 HPI_HPID_NOINC_2
= data2
;
310 /* read from non- auto inc regs */
311 static u32
hpi_read_noinc(u32 addr
)
313 u16 addr1
, addr2
, data1
, data2
;
316 addr1
= (u16
) ((addr
>> 16) & 0xffff); /* First HW is most significant */
317 addr2
= (u16
) (addr
& 0xffff);
322 /* printf("hpi_read_noinc: addr1=0x%x, addr2=0x%x\n", addr1, addr2); */
324 data1
= HPI_HPID_NOINC_1
;
325 data2
= HPI_HPID_NOINC_2
;
327 /* printf("hpi_read_noinc: data1=0x%x, data2=0x%x\n", data1, data2); */
329 ret
= (((u32
) data1
) << 16) | (data2
& 0xffff);
335 * Host Port Interface Tests
338 #ifndef HPI_TEST_OSZI
339 /* main test function */
343 u32 i
, ii
, pattern
, tmp
;
345 pattern
= HPI_TEST_PATTERN
;
347 u32 test_data
[HPI_TEST_CHUNKSIZE
];
348 u32 read_data
[HPI_TEST_CHUNKSIZE
];
350 debugX(2, "hpi_test: activating hpi...");
355 /* Dump the first 1024 bytes
358 for(i
=0; i
<1024; i
+=4) {
360 printf("\n0x%08x: ", i
);
361 printf("0x%08x ", hpi_read_noinc(i
));
365 /* HPIA read-write test
368 debugX(1, "hpi_test: starting HPIA read-write tests...\n");
369 err
|= hpi_write_addr_test(0xdeadc0de);
370 err
|= hpi_write_addr_test(0xbeefd00d);
371 err
|= hpi_write_addr_test(0xabcd1234);
372 err
|= hpi_write_addr_test(0xaaaaaaaa);
374 debugX(1, "hpi_test: HPIA read-write tests: *** FAILED ***\n");
377 debugX(1, "hpi_test: HPIA read-write tests: OK\n");
380 /* read write test using nonincremental data regs
383 debugX(1, "hpi_test: starting nonincremental tests...\n");
384 for(i
=HPI_TEST_START
; i
<HPI_TEST_END
; i
+=4) {
385 err
|= hpi_read_write_test(i
, pattern
);
387 /* stolen from cmd_mem.c */
388 if(pattern
& 0x80000000) {
389 pattern
= -pattern
; /* complement & increment */
393 err
|= hpi_read_write_test(i
, pattern
);
396 debugX(1, "hpi_test: nonincremental tests *** FAILED ***\n");
400 debugX(1, "hpi_test: nonincremental test OK\n");
402 /* read write a chunk of data using nonincremental data regs
405 debugX(1, "hpi_test: starting nonincremental chunk tests...\n");
406 pattern
= HPI_TEST_PATTERN
;
407 for(i
=HPI_TEST_START
; i
<HPI_TEST_END
; i
+=4) {
408 hpi_write_noinc(i
, pattern
);
410 /* stolen from cmd_mem.c */
411 if(pattern
& 0x80000000) {
412 pattern
= -pattern
; /* complement & increment */
417 pattern
= HPI_TEST_PATTERN
;
418 for(i
=HPI_TEST_START
; i
<HPI_TEST_END
; i
+=4) {
419 tmp
= hpi_read_noinc(i
);
422 debugX(1, "hpi_test: noninc chunk test *** FAILED *** @ 0x%x, written=0x%x, read=0x%x\n", i
, pattern
, tmp
);
425 /* stolen from cmd_mem.c */
426 if(pattern
& 0x80000000) {
427 pattern
= -pattern
; /* complement & increment */
434 debugX(1, "hpi_test: nonincremental chunk test OK\n");
438 /* small verbose test using autoinc and nonautoinc to compare
441 debugX(1, "hpi_test: tiny_autoinc_test...\n");
442 hpi_tiny_autoinc_test();
443 debugX(1, "hpi_test: tiny_autoinc_test done\n");
444 #endif /* DO_TINY_TEST */
447 /* $%& write a chunk of data using the autoincremental regs
450 debugX(1, "hpi_test: starting autoinc test %d chunks with 0x%x bytes...\n",
451 ((HPI_TEST_END
- HPI_TEST_START
) / HPI_TEST_CHUNKSIZE
),
454 for(i
=HPI_TEST_START
;
455 i
< ((HPI_TEST_END
- HPI_TEST_START
) / HPI_TEST_CHUNKSIZE
);
457 /* generate the pattern data */
458 debugX(3, "generating pattern data: ");
459 for(ii
= 0; ii
< HPI_TEST_CHUNKSIZE
; ii
++) {
460 debugX(3, "0x%x ", pattern
);
462 test_data
[ii
] = pattern
;
463 read_data
[ii
] = 0x0; /* zero to be sure */
465 /* stolen from cmd_mem.c */
466 if(pattern
& 0x80000000) {
467 pattern
= -pattern
; /* complement & increment */
474 debugX(2, "Writing autoinc data @ 0x%x\n", i
);
475 hpi_write_inc(i
, test_data
, HPI_TEST_CHUNKSIZE
);
477 debugX(2, "Reading autoinc data @ 0x%x\n", i
);
478 hpi_read_inc(i
, read_data
, HPI_TEST_CHUNKSIZE
);
481 for(ii
= 0; ii
< HPI_TEST_CHUNKSIZE
; ii
++) {
482 debugX(3, "hpi_test_autoinc: @ 0x%x, written=0x%x, read=0x%x", i
+ii
, test_data
[ii
], read_data
[ii
]);
483 if(read_data
[ii
] != test_data
[ii
]) {
484 debugX(0, "hpi_test: autoinc test @ 0x%x, written=0x%x, read=0x%x *** FAILED ***\n", i
+ii
, test_data
[ii
], read_data
[ii
]);
489 debugX(1, "hpi_test: autoinc test OK\n");
493 #else /* HPI_TEST_OSZI */
497 u32 read_data
[TINY_AUTOINC_DATA_SIZE
];
499 unsigned int dummy_data
[TINY_AUTOINC_DATA_SIZE
] = {
500 0x11112222, 0x33334444, 0x55556666, 0x77778888,
501 0x9999aaaa, 0xbbbbcccc, 0xddddeeee, 0xffff1111,
502 0x00010002, 0x00030004, 0x00050006, 0x00070008,
503 0x0009000a, 0x000b000c, 0x000d000e, 0x000f0001
506 debugX(0, "hpi_test: activating hpi...");
512 debugX(0, " writing to autoinc...\n");
513 hpi_write_inc(TINY_AUTOINC_BASE_ADDR
,
514 dummy_data
, TINY_AUTOINC_DATA_SIZE
);
516 debugX(0, " reading from autoinc...\n");
517 hpi_read_inc(TINY_AUTOINC_BASE_ADDR
,
518 read_data
, TINY_AUTOINC_DATA_SIZE
);
520 for(i
=0; i
< (TINY_AUTOINC_DATA_SIZE
); i
++) {
521 debugX(0, " written=0x%x, read(inc)=0x%x\n",
522 dummy_data
[i
], read_data
[i
]);
531 /* test if Host Port Address Register can be written correctly */
532 static int hpi_write_addr_test(u32 addr
)
536 HPI_HPIA_1
= ((u16
) (addr
>> 16)); /* First HW is most significant */
537 HPI_HPIA_2
= ((u16
) addr
);
539 read_back
= (((u32
) HPI_HPIA_1
)<<16) | ((u32
) HPI_HPIA_2
);
541 if(read_back
== addr
) {
542 debugX(2, " hpi_write_addr_test OK: written=0x%x, read=0x%x\n",
546 debugX(0, " hpi_write_addr_test *** FAILED ***: written=0x%x, read=0x%x\n",
554 /* test if a simple read/write sequence succeeds */
555 static int hpi_read_write_test(u32 addr
, u32 data
)
559 hpi_write_noinc(addr
, data
);
560 read_back
= hpi_read_noinc(addr
);
562 if(read_back
== data
) {
563 debugX(2, " hpi_read_write_test: OK, addr=0x%x written=0x%x, read=0x%x\n", addr
, data
, read_back
);
566 debugX(0, " hpi_read_write_test: *** FAILED ***, addr=0x%x written=0x%x, read=0x%x\n", addr
, data
, read_back
);
573 static int hpi_tiny_autoinc_test(void)
576 u32 read_data
[TINY_AUTOINC_DATA_SIZE
];
577 u32 read_data_noinc
[TINY_AUTOINC_DATA_SIZE
];
579 unsigned int dummy_data
[TINY_AUTOINC_DATA_SIZE
] = {
580 0x11112222, 0x33334444, 0x55556666, 0x77778888,
581 0x9999aaaa, 0xbbbbcccc, 0xddddeeee, 0xffff1111,
582 0x00010002, 0x00030004, 0x00050006, 0x00070008,
583 0x0009000a, 0x000b000c, 0x000d000e, 0x000f0001
586 printf(" writing to autoinc...\n");
587 hpi_write_inc(TINY_AUTOINC_BASE_ADDR
, dummy_data
, TINY_AUTOINC_DATA_SIZE
);
589 printf(" reading from autoinc...\n");
590 hpi_read_inc(TINY_AUTOINC_BASE_ADDR
, read_data
, TINY_AUTOINC_DATA_SIZE
);
592 printf(" reading from noinc for comparison...\n");
593 for(i
=0; i
< (TINY_AUTOINC_DATA_SIZE
); i
++)
594 read_data_noinc
[i
] = hpi_read_noinc(TINY_AUTOINC_BASE_ADDR
+i
*4);
596 for(i
=0; i
< (TINY_AUTOINC_DATA_SIZE
); i
++) {
597 printf(" written=0x%x, read(inc)=0x%x, read(noinc)=0x%x\n",
598 dummy_data
[i
], read_data
[i
], read_data_noinc
[i
]);
603 #endif /* CONFIG_SPC1920_HPI_TEST */