4 #if defined(CONFIG_CMD_BSP)
9 #include <galileo/pci.h>
14 #define PAT_LO 0x00010203
15 #define PAT_HI 0x04050607
17 static PBB_DMA_REG_MAP
*zuma_pbb_reg
= NULL
;
18 static char test_buf1
[2048];
19 static char test_buf2
[2048];
20 void zuma_init_pbb(void);
21 int zuma_mbox_init(void);
22 int zuma_test_dma(int cmd
, int size
);
24 int zuma_test_dma (int cmd
, int size
)
26 static const char *const test_legend
[] = {
29 "write inc", "verify inc"
32 unsigned int p1
= ((unsigned int) test_buf1
+ 0xff) & (~0xff);
33 unsigned int p2
= ((unsigned int) test_buf2
+ 0xff) & (~0xff);
34 volatile unsigned int *ps
= (unsigned int *) p1
;
35 volatile unsigned int *pd
= (unsigned int *) p2
;
36 unsigned int funct
, pat_lo
= PAT_LO
, pat_hi
= PAT_HI
;
41 printf ("not initted\n");
45 if (cmd
< 0 || cmd
> 5) {
46 printf ("inv cmd %d\n", cmd
);
50 if (cmd
== 2 || cmd
== 3) {
55 if (size
<= 0 || size
> 1024)
58 size
&= (~7); /* throw away bottom 3 bits */
60 p1
= ((unsigned int) test_buf1
+ 0xff) & (~0xff);
61 p2
= ((unsigned int) test_buf2
+ 0xff) & (~0xff);
63 memset ((void *) p1
, 0, size
);
64 memset ((void *) p2
, 0, size
);
66 for (i
= 0; i
< size
/ 4; i
+= 2) {
69 if (cmd
== 4 || cmd
== 5) {
70 unsigned char *pl
= (unsigned char *) &pat_lo
;
71 unsigned char *ph
= (unsigned char *) &pat_hi
;
73 for (j
= 0; j
< 4; j
++) {
80 funct
= (1 << 31) | (cmd
<< 24) | (size
);
82 zuma_pbb_reg
->int_mask
.pci_bits
.chan0
=
83 EOF_RX_FLAG
| EOF_TX_FLAG
| EOB_TX_FLAG
;
85 zuma_pbb_reg
->debug_57
= PAT_LO
; /* patl */
86 zuma_pbb_reg
->debug_58
= PAT_HI
; /* path */
88 zuma_pbb_reg
->debug_54
= cpu_to_le32 (p1
); /* src 0x01b0 */
89 zuma_pbb_reg
->debug_55
= cpu_to_le32 (p2
); /* dst 0x01b8 */
90 zuma_pbb_reg
->debug_56
= cpu_to_le32 (funct
); /* func, 0x01c0 */
92 /* give DMA time to chew on things.. dont use DRAM or PCI */
93 /* if you can avoid it. */
95 for (i
= 0; i
< 1000 * 10; i
++);
96 } while (le32_to_cpu (zuma_pbb_reg
->debug_56
) & (1 << 31));
98 stat
.word
= zuma_pbb_reg
->status
.word
;
99 zuma_pbb_reg
->int_mask
.word
= 0;
101 printf ("stat: %08x (%x)\n", stat
.word
, stat
.pci_bits
.chan0
);
103 printf ("func: %08x\n", le32_to_cpu (zuma_pbb_reg
->debug_56
));
104 printf ("src @%08x: %08x %08x %08x %08x\n", p1
, ps
[0], ps
[1], ps
[2],
106 printf ("dst @%08x: %08x %08x %08x %08x\n", p2
, pd
[0], pd
[1], pd
[2],
108 printf ("func: %08x\n", le32_to_cpu (zuma_pbb_reg
->debug_56
));
111 if (cmd
== 0 || cmd
== 4) {
112 /* this is a write */
113 if (!(stat
.pci_bits
.chan0
& EOF_RX_FLAG
) || /* not done */
114 (memcmp ((void *) ps
, (void *) pd
, size
) != 0)) { /* cmp error */
115 for (i
= 0; i
< size
/ 4; i
+= 2) {
116 if ((ps
[i
] != pd
[i
]) || (ps
[i
+ 1] != pd
[i
+ 1])) {
117 printf ("s @%p:%08x %08x\n", &ps
[i
], ps
[i
], ps
[i
+ 1]);
118 printf ("d @%p:%08x %08x\n", &pd
[i
], pd
[i
], pd
[i
+ 1]);
124 /* this is a verify */
125 if (!(stat
.pci_bits
.chan0
& EOF_TX_FLAG
) || /* not done */
126 (stat
.pci_bits
.chan0
& EOB_TX_FLAG
)) { /* cmp error */
127 printf ("%08x: %08x %08x\n",
128 le32_to_cpu (zuma_pbb_reg
->debug_63
),
129 zuma_pbb_reg
->debug_61
, zuma_pbb_reg
->debug_62
);
134 printf ("%s cmd %d, %d bytes: %s!\n", test_legend
[cmd
], cmd
, size
,
135 (ret
== 0) ? "PASSED" : "FAILED");
139 void zuma_init_pbb (void)
143 pci_find_device (VENDOR_ID_ZUMA
, DEVICE_ID_ZUMA_PBB
, 0);
146 printf ("no zuma pbb\n");
150 pci_read_config_dword (dev
, PCI_BASE_ADDRESS_0
, &iobase
);
153 (PBB_DMA_REG_MAP
*) (iobase
& PCI_BASE_ADDRESS_MEM_MASK
);
156 printf ("zuma pbb bar none! (hah hah, get it?)\n");
160 zuma_pbb_reg
->int_mask
.word
= 0;
162 printf ("pbb @ %p v%d.%d, timestamp %08x\n", zuma_pbb_reg
,
163 zuma_pbb_reg
->version
.pci_bits
.rev_major
,
164 zuma_pbb_reg
->version
.pci_bits
.rev_minor
,
165 zuma_pbb_reg
->timestamp
);
169 #if defined(CONFIG_CMD_BSP)
171 static int last_cmd
= 4; /* write increment */
172 static int last_size
= 64;
175 do_zuma_init_pbb (cmd_tbl_t
*cmdtp
, int flag
, int argc
, char *argv
[])
182 do_zuma_test_dma (cmd_tbl_t
*cmdtp
, int flag
, int argc
, char *argv
[])
185 last_cmd
= simple_strtoul (argv
[1], NULL
, 10);
188 last_size
= simple_strtoul (argv
[2], NULL
, 10);
190 zuma_test_dma (last_cmd
, last_size
);
195 do_zuma_init_mbox (cmd_tbl_t
*cmdtp
, int flag
, int argc
, char *argv
[])
202 zinit
, 1, 0, do_zuma_init_pbb
,
203 "zinit - init zuma pbb\n",
208 zdtest
, 3, 1, do_zuma_test_dma
,
209 "zdtest - run dma test\n",
211 " - run dma cmd (w=0,v=1,cp=2,cmp=3,wi=4,vi=5), count bytes\n"
214 zminit
, 1, 0, do_zuma_init_mbox
,
215 "zminit - init zuma mbox\n",
217 " - init zuma mbox\n"