mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-08-22 09:58:52 +09:00
221 lines
5.1 KiB
C
221 lines
5.1 KiB
C
#include <common.h>
|
|
#include <malloc.h>
|
|
|
|
#if (CONFIG_COMMANDS & CFG_CMD_BSP)
|
|
#include <command.h>
|
|
#endif
|
|
|
|
#include <pci.h>
|
|
#include <galileo/pci.h>
|
|
#include "zuma_pbb.h"
|
|
|
|
#undef DEBUG
|
|
|
|
#define PAT_LO 0x00010203
|
|
#define PAT_HI 0x04050607
|
|
|
|
static PBB_DMA_REG_MAP *zuma_pbb_reg = NULL;
|
|
static char test_buf1[2048];
|
|
static char test_buf2[2048];
|
|
void zuma_init_pbb(void);
|
|
int zuma_mbox_init(void);
|
|
int zuma_test_dma(int cmd, int size);
|
|
|
|
int zuma_test_dma (int cmd, int size)
|
|
{
|
|
static const char *const test_legend[] = {
|
|
"write", "verify",
|
|
"copy", "compare",
|
|
"write inc", "verify inc"
|
|
};
|
|
register int i, j;
|
|
unsigned int p1 = ((unsigned int) test_buf1 + 0xff) & (~0xff);
|
|
unsigned int p2 = ((unsigned int) test_buf2 + 0xff) & (~0xff);
|
|
volatile unsigned int *ps = (unsigned int *) p1;
|
|
volatile unsigned int *pd = (unsigned int *) p2;
|
|
unsigned int funct, pat_lo = PAT_LO, pat_hi = PAT_HI;
|
|
DMA_INT_STATUS stat;
|
|
int ret = 0;
|
|
|
|
if (!zuma_pbb_reg) {
|
|
printf ("not initted\n");
|
|
return -1;
|
|
}
|
|
|
|
if (cmd < 0 || cmd > 5) {
|
|
printf ("inv cmd %d\n", cmd);
|
|
return -1;
|
|
}
|
|
|
|
if (cmd == 2 || cmd == 3) {
|
|
/* not implemented */
|
|
return 0;
|
|
}
|
|
|
|
if (size <= 0 || size > 1024)
|
|
size = 1024;
|
|
|
|
size &= (~7); /* throw away bottom 3 bits */
|
|
|
|
p1 = ((unsigned int) test_buf1 + 0xff) & (~0xff);
|
|
p2 = ((unsigned int) test_buf2 + 0xff) & (~0xff);
|
|
|
|
memset ((void *) p1, 0, size);
|
|
memset ((void *) p2, 0, size);
|
|
|
|
for (i = 0; i < size / 4; i += 2) {
|
|
ps[i] = pat_lo;
|
|
ps[i + 1] = pat_hi;
|
|
if (cmd == 4 || cmd == 5) {
|
|
unsigned char *pl = (unsigned char *) &pat_lo;
|
|
unsigned char *ph = (unsigned char *) &pat_hi;
|
|
|
|
for (j = 0; j < 4; j++) {
|
|
pl[j] += 8;
|
|
ph[j] += 8;
|
|
}
|
|
}
|
|
}
|
|
|
|
funct = (1 << 31) | (cmd << 24) | (size);
|
|
|
|
zuma_pbb_reg->int_mask.pci_bits.chan0 =
|
|
EOF_RX_FLAG | EOF_TX_FLAG | EOB_TX_FLAG;
|
|
|
|
zuma_pbb_reg->debug_57 = PAT_LO; /* patl */
|
|
zuma_pbb_reg->debug_58 = PAT_HI; /* path */
|
|
|
|
zuma_pbb_reg->debug_54 = cpu_to_le32 (p1); /* src 0x01b0 */
|
|
zuma_pbb_reg->debug_55 = cpu_to_le32 (p2); /* dst 0x01b8 */
|
|
zuma_pbb_reg->debug_56 = cpu_to_le32 (funct); /* func, 0x01c0 */
|
|
|
|
/* give DMA time to chew on things.. dont use DRAM or PCI */
|
|
/* if you can avoid it. */
|
|
do {
|
|
for (i = 0; i < 1000 * 10; i++);
|
|
} while (le32_to_cpu (zuma_pbb_reg->debug_56) & (1 << 31));
|
|
|
|
stat.word = zuma_pbb_reg->status.word;
|
|
zuma_pbb_reg->int_mask.word = 0;
|
|
|
|
printf ("stat: %08x (%x)\n", stat.word, stat.pci_bits.chan0);
|
|
|
|
printf ("func: %08x\n", le32_to_cpu (zuma_pbb_reg->debug_56));
|
|
printf ("src @%08x: %08x %08x %08x %08x\n", p1, ps[0], ps[1], ps[2],
|
|
ps[3]);
|
|
printf ("dst @%08x: %08x %08x %08x %08x\n", p2, pd[0], pd[1], pd[2],
|
|
pd[3]);
|
|
printf ("func: %08x\n", le32_to_cpu (zuma_pbb_reg->debug_56));
|
|
|
|
|
|
if (cmd == 0 || cmd == 4) {
|
|
/* this is a write */
|
|
if (!(stat.pci_bits.chan0 & EOF_RX_FLAG) || /* not done */
|
|
(memcmp ((void *) ps, (void *) pd, size) != 0)) { /* cmp error */
|
|
for (i = 0; i < size / 4; i += 2) {
|
|
if ((ps[i] != pd[i]) || (ps[i + 1] != pd[i + 1])) {
|
|
printf ("s @%p:%08x %08x\n", &ps[i], ps[i], ps[i + 1]);
|
|
printf ("d @%p:%08x %08x\n", &pd[i], pd[i], pd[i + 1]);
|
|
}
|
|
}
|
|
ret = -1;
|
|
}
|
|
} else {
|
|
/* this is a verify */
|
|
if (!(stat.pci_bits.chan0 & EOF_TX_FLAG) || /* not done */
|
|
(stat.pci_bits.chan0 & EOB_TX_FLAG)) { /* cmp error */
|
|
printf ("%08x: %08x %08x\n",
|
|
le32_to_cpu (zuma_pbb_reg->debug_63),
|
|
zuma_pbb_reg->debug_61, zuma_pbb_reg->debug_62);
|
|
ret = -1;
|
|
}
|
|
}
|
|
|
|
printf ("%s cmd %d, %d bytes: %s!\n", test_legend[cmd], cmd, size,
|
|
(ret == 0) ? "PASSED" : "FAILED");
|
|
return 0;
|
|
}
|
|
|
|
void zuma_init_pbb (void)
|
|
{
|
|
unsigned int iobase;
|
|
pci_dev_t dev =
|
|
pci_find_device (VENDOR_ID_ZUMA, DEVICE_ID_ZUMA_PBB, 0);
|
|
|
|
if (dev == -1) {
|
|
printf ("no zuma pbb\n");
|
|
return;
|
|
}
|
|
|
|
pci_read_config_dword (dev, PCI_BASE_ADDRESS_0, &iobase);
|
|
|
|
zuma_pbb_reg =
|
|
(PBB_DMA_REG_MAP *) (iobase & PCI_BASE_ADDRESS_MEM_MASK);
|
|
|
|
if (!zuma_pbb_reg) {
|
|
printf ("zuma pbb bar none! (hah hah, get it?)\n");
|
|
return;
|
|
}
|
|
|
|
zuma_pbb_reg->int_mask.word = 0;
|
|
|
|
printf ("pbb @ %p v%d.%d, timestamp %08x\n", zuma_pbb_reg,
|
|
zuma_pbb_reg->version.pci_bits.rev_major,
|
|
zuma_pbb_reg->version.pci_bits.rev_minor,
|
|
zuma_pbb_reg->timestamp);
|
|
|
|
}
|
|
|
|
#if (CONFIG_COMMANDS & CFG_CMD_BSP)
|
|
|
|
static int last_cmd = 4; /* write increment */
|
|
static int last_size = 64;
|
|
|
|
int
|
|
do_zuma_init_pbb (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
|
|
{
|
|
zuma_init_pbb ();
|
|
return 0;
|
|
}
|
|
|
|
int
|
|
do_zuma_test_dma (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
|
|
{
|
|
if (argc > 1) {
|
|
last_cmd = simple_strtoul (argv[1], NULL, 10);
|
|
}
|
|
if (argc > 2) {
|
|
last_size = simple_strtoul (argv[2], NULL, 10);
|
|
}
|
|
zuma_test_dma (last_cmd, last_size);
|
|
return 0;
|
|
}
|
|
|
|
int
|
|
do_zuma_init_mbox (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
|
|
{
|
|
zuma_mbox_init ();
|
|
return 0;
|
|
}
|
|
|
|
U_BOOT_CMD(
|
|
zinit, 1, 0, do_zuma_init_pbb,
|
|
"zinit - init zuma pbb\n",
|
|
"\n"
|
|
" - init zuma pbb\n"
|
|
);
|
|
U_BOOT_CMD(
|
|
zdtest, 3, 1, do_zuma_test_dma,
|
|
"zdtest - run dma test\n",
|
|
"[cmd [count]]\n"
|
|
" - run dma cmd (w=0,v=1,cp=2,cmp=3,wi=4,vi=5), count bytes\n"
|
|
);
|
|
U_BOOT_CMD(
|
|
zminit, 1, 0, do_zuma_init_mbox,
|
|
"zminit - init zuma mbox\n",
|
|
"\n"
|
|
" - init zuma mbox\n"
|
|
);
|
|
|
|
#endif /* CFG_CMD_BSP */
|