]> git.sur5r.net Git - u-boot/blobdiff - board/esd/pci405/cmd_pci405.c
Sync'd u-boot-net with mainline
[u-boot] / board / esd / pci405 / cmd_pci405.c
index df91cd4176135dbd1cbccd2fa406073d78aa0c61..5b5ad8c4465d8afd99ac5ba5f04d13386bffd15e 100644 (file)
@@ -1,5 +1,5 @@
 /*
- * (C) Copyright 2002
+ * (C) Copyright 2002-2004
  * Stefan Roese, esd gmbh germany, stefan.roese@esd-electronics.com
  *
  * See file CREDITS for list of people who contributed to this
 #include <asm/io.h>
 #include <pci.h>
 #include <405gp_pci.h>
+#include <asm/processor.h>
 
 #include "pci405.h"
 
 
-#if (CONFIG_COMMANDS & CFG_CMD_BSP)
+#if defined(CONFIG_CMD_BSP)
 
 extern int do_bootm (cmd_tbl_t *, int, int, char *[]);
+extern int do_bootvx (cmd_tbl_t *, int, int, char *[]);
+unsigned long get_dcr(unsigned short);
 
 
 /*
@@ -88,24 +91,895 @@ int do_loadpci(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
                        pci_read_config_dword(PCIDEVID_405GP, i, ptr++);
                }
                ptr = (unsigned int *)PCI_REGS_ADDR;
-               *ptr = crc32(0, (char *)PCI_REGS_ADDR+4, PCI_REGS_LEN-4);
+               *ptr = crc32(0, (uchar *)PCI_REGS_ADDR+4, PCI_REGS_LEN-4);
 
                printf("\nStoring PCI Configuration Regs...\n");
        } else {
                sprintf(addr, "%08x", *ptr);
 
+#if 0
                /*
                 * Boot image
                 */
-               printf("\nBooting image at addr 0x%s ...\n", addr);
+               if (*ptr & 0x00000001) {
+                       /*
+                        * Boot VxWorks image via bootvx
+                        */
+                       addr[strlen(addr)-1] = '0';
+                       printf("\nBooting VxWorks-Image at addr 0x%s ...\n", addr);
+                       setenv("loadaddr", addr);
+
+                       local_args[0] = argv[0];
+                       local_args[1] = NULL;
+                       status = do_bootvx (cmdtp, 0, 1, local_args);
+               } else {
+                       /*
+                        * Boot image via bootm (normally Linux)
+                        */
+                       printf("\nBooting Image at addr 0x%s ...\n", addr);
+                       setenv("loadaddr", addr);
+
+                       local_args[0] = argv[0];
+                       local_args[1] = NULL;
+                       status = do_bootm (cmdtp, 0, 1, local_args);
+               }
+#else
+               /*
+                * Boot image via bootm
+                */
+               printf("\nBooting Image at addr 0x%s ...\n", addr);
                setenv("loadaddr", addr);
 
                local_args[0] = argv[0];
                local_args[1] = NULL;
                status = do_bootm (cmdtp, 0, 1, local_args);
+#endif
+       }
+
+       return 0;
+}
+U_BOOT_CMD(
+       loadpci,        1,      1,      do_loadpci,
+       "loadpci - Wait for pci-image and boot it\n",
+       NULL
+);
+
+#endif
+
+#if 1 /* test-only */
+int do_getpci(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
+{
+       unsigned int val;
+       int i;
+
+       printf("\nPCI Configuration Regs for PPC405GP:");
+       for (i=0; i<0x64; i+=4) {
+               pci_read_config_dword(PCIDEVID_405GP, i, &val);
+               if (!(i % 0x10)) {
+                       printf("\n%02x: ", i);
+               }
+               printf("%08x ", val);
+       }
+       printf("\n");
+
+       return 0;
+}
+U_BOOT_CMD(
+       getpci, 1,      1,      do_getpci,
+       "getpci  - Print own pci configuration registers\n",
+       NULL
+);
+
+int do_setpci(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
+{
+       unsigned int addr;
+       unsigned int val;
+
+       addr = simple_strtol (argv[1], NULL, 16);
+       val = simple_strtol (argv[2], NULL, 16);
+
+       printf("\nWriting %08x to PCI reg %08x.\n", val, addr);
+       pci_write_config_dword(PCIDEVID_405GP, addr, val);
+
+       return 0;
+}
+U_BOOT_CMD(
+       setpci, 3,      1,      do_setpci,
+       "setpci  - Set one pci configuration lword\n",
+       "<addr> <val>\n"
+       "        - Write pci configuration lword <val> to <addr>.\n"
+);
+
+int do_dumpdcr(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
+{
+       int i;
+
+       printf("\nDevice Configuration Registers (DCR's) for PPC405GP:");
+       for (i=0; i<=0x1e0; i++) {
+               if (!(i % 0x8)) {
+                       printf("\n%04x ", i);
+               }
+               printf("%08lx ", get_dcr(i));
+       }
+       printf("\n");
+
+       return 0;
+}
+U_BOOT_CMD(
+       dumpdcr,        1,      1,      do_dumpdcr,
+       "dumpdcr - Dump all DCR registers\n",
+       NULL
+);
+
+
+int do_dumpspr(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
+{
+       printf("\nSpecial Purpose Registers (SPR's) for PPC405GP:");
+       printf("\n%04x %08x ", 947, mfspr(947));
+       printf("\n%04x %08x ", 9, mfspr(9));
+       printf("\n%04x %08x ", 1014, mfspr(1014));
+       printf("\n%04x %08x ", 1015, mfspr(1015));
+       printf("\n%04x %08x ", 1010, mfspr(1010));
+       printf("\n%04x %08x ", 957, mfspr(957));
+       printf("\n%04x %08x ", 1008, mfspr(1008));
+       printf("\n%04x %08x ", 1018, mfspr(1018));
+       printf("\n%04x %08x ", 954, mfspr(954));
+       printf("\n%04x %08x ", 950, mfspr(950));
+       printf("\n%04x %08x ", 951, mfspr(951));
+       printf("\n%04x %08x ", 981, mfspr(981));
+       printf("\n%04x %08x ", 980, mfspr(980));
+       printf("\n%04x %08x ", 982, mfspr(982));
+       printf("\n%04x %08x ", 1012, mfspr(1012));
+       printf("\n%04x %08x ", 1013, mfspr(1013));
+       printf("\n%04x %08x ", 948, mfspr(948));
+       printf("\n%04x %08x ", 949, mfspr(949));
+       printf("\n%04x %08x ", 1019, mfspr(1019));
+       printf("\n%04x %08x ", 979, mfspr(979));
+       printf("\n%04x %08x ", 8, mfspr(8));
+       printf("\n%04x %08x ", 945, mfspr(945));
+       printf("\n%04x %08x ", 987, mfspr(987));
+       printf("\n%04x %08x ", 287, mfspr(287));
+       printf("\n%04x %08x ", 953, mfspr(953));
+       printf("\n%04x %08x ", 955, mfspr(955));
+       printf("\n%04x %08x ", 272, mfspr(272));
+       printf("\n%04x %08x ", 273, mfspr(273));
+       printf("\n%04x %08x ", 274, mfspr(274));
+       printf("\n%04x %08x ", 275, mfspr(275));
+       printf("\n%04x %08x ", 260, mfspr(260));
+       printf("\n%04x %08x ", 276, mfspr(276));
+       printf("\n%04x %08x ", 261, mfspr(261));
+       printf("\n%04x %08x ", 277, mfspr(277));
+       printf("\n%04x %08x ", 262, mfspr(262));
+       printf("\n%04x %08x ", 278, mfspr(278));
+       printf("\n%04x %08x ", 263, mfspr(263));
+       printf("\n%04x %08x ", 279, mfspr(279));
+       printf("\n%04x %08x ", 26, mfspr(26));
+       printf("\n%04x %08x ", 27, mfspr(27));
+       printf("\n%04x %08x ", 990, mfspr(990));
+       printf("\n%04x %08x ", 991, mfspr(991));
+       printf("\n%04x %08x ", 956, mfspr(956));
+       printf("\n%04x %08x ", 284, mfspr(284));
+       printf("\n%04x %08x ", 285, mfspr(285));
+       printf("\n%04x %08x ", 986, mfspr(986));
+       printf("\n%04x %08x ", 984, mfspr(984));
+       printf("\n%04x %08x ", 256, mfspr(256));
+       printf("\n%04x %08x ", 1, mfspr(1));
+       printf("\n%04x %08x ", 944, mfspr(944));
+       printf("\n");
+
+       return 0;
+}
+U_BOOT_CMD(
+       dumpspr,        1,      1,      do_dumpspr,
+       "dumpspr - Dump all SPR registers\n",
+       NULL
+);
+
+
+#define PCI0_BRDGOPT1 0x4a
+#define plb0_acr      0x87
+
+int do_getplb(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
+{
+       unsigned short val;
+
+       printf("PLB0_ACR=%08lx\n", get_dcr(0x87));
+       pci_read_config_word(PCIDEVID_405GP, PCI0_BRDGOPT1, &val);
+       printf("PCI0_BRDGOPT1=%04x\n", val);
+       printf("CCR0=%08x\n", mfspr(ccr0));
+
+       return 0;
+}
+U_BOOT_CMD(
+       getplb, 1,      1,      do_getplb,
+       "getplb  - Dump all plb arbiter registers\n",
+       NULL
+);
+
+int do_setplb(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
+{
+       unsigned int my_acr;
+       unsigned int my_brdgopt1;
+       unsigned int my_ccr0;
+
+       my_acr = simple_strtol (argv[1], NULL, 16);
+       my_brdgopt1 = simple_strtol (argv[2], NULL, 16);
+       my_ccr0 = simple_strtol (argv[3], NULL, 16);
+
+       mtdcr(plb0_acr, my_acr);
+       pci_write_config_word(PCIDEVID_405GP, PCI0_BRDGOPT1, my_brdgopt1);
+       mtspr(ccr0, my_ccr0);
+
+       return 0;
+}
+U_BOOT_CMD(
+       setplb, 4,      1,      do_setplb,
+       "setplb  - Set all plb arbiter registers\n",
+       "PLB0_ACR PCI0_BRDGOPT1 CCR0\n"
+       "        - Set all plb arbiter registers\n"
+);
+
+
+/***********************************************************************
+ *
+ * The following code is only for test purposes!!!!
+ * Please ignore this ugly stuff!!!!!!!!!!!!!!!!!!!
+ *
+ ***********************************************************************/
+
+#define PCI_ADDR 0xc0000000
+
+int do_writepci(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
+{
+       unsigned int addr;
+       unsigned int size;
+       unsigned int countmax;
+       int i;
+       int max;
+       volatile unsigned long *ptr;
+       volatile unsigned long val;
+       int loopcount = 0;
+       int test_pci_read = 0;
+       int test_pci_cfg_write = 0;
+       int test_sync = 0;
+       int test_pci_pre_read = 0;
+
+       addr = simple_strtol (argv[1], NULL, 16);
+       size = simple_strtol (argv[2], NULL, 16);
+       countmax = simple_strtol (argv[3], NULL, 16);
+       if (countmax == 0)
+               countmax = 1000;
+
+       do_getplb(NULL, 0, 0, NULL);
+
+#if 0
+       out32r(PMM0LA, 0);
+       out32r(PMM0PCILA, 0);
+       out32r(PMM0PCIHA, 0);
+       out32r(PMM0MA, 0);
+       out32r(PMM1LA, PCI_ADDR);
+       out32r(PMM1PCILA, addr & 0xff000000);
+       out32r(PMM1PCIHA, 0x00000000);
+       out32r(PMM1MA, 0xff000001);
+#endif
+
+       printf("PMM1LA    =%08lx\n", in32r(PMM1LA));
+       printf("PMM1MA    =%08lx\n", in32r(PMM1MA));
+       printf("PMM1PCILA =%08lx\n", in32r(PMM1PCILA));
+       printf("PMM1PCIHA =%08lx\n", in32r(PMM1PCIHA));
+
+       addr = PCI_ADDR | (addr & 0x00ffffff);
+       printf("\nWriting at addr %08x, size %08x (countmax=%x)\n", addr, size, countmax);
+
+       max = size >> 2;
+
+       pci_write_config_word(PCIDEVID_405GP, 0x04, 0x0106); /* write command reg */
+
+       val = *(ulong *)0x00000000;
+       if (val & 0x00000008) {
+               test_pci_pre_read = 1;
+               printf("Running test with pre pci-memory-read access!\n");
+       }
+       if (val & 0x00000004) {
+               test_sync = 1;
+               printf("Running test with sync instruction!\n");
+       }
+       if (val & 0x00000001) {
+               test_pci_read = 1;
+               printf("Running test with pci-memory-read access!\n");
+       }
+       if (val & 0x00000002) {
+               test_pci_cfg_write = 1;
+               printf("Running test with pci-config-write access!\n");
+       }
+
+       while (1) {
+
+               if (test_pci_pre_read) {
+                       /*
+                        * Read one value back
+                        */
+                       ptr = (volatile unsigned long *)addr;
+                       val = *ptr;
+               }
+
+               /*
+                * Write some values to host via pci busmastering
+                */
+               ptr = (volatile unsigned long *)addr;
+               for (i=0; i<max; i++) {
+                       *ptr++ = i;
+               }
+
+               if (test_sync) {
+                       /*
+                        * Sync previous writes
+                        */
+                       ppcSync();
+               }
+
+               if (test_pci_read) {
+                       /*
+                        * Read one value back
+                        */
+                       ptr = (volatile unsigned long *)addr;
+                       val = *ptr;
+               }
+
+               if (test_pci_cfg_write) {
+                       /*
+                        * Generate IRQ to host via config regs
+                        */
+                       pci_write_config_byte(PCIDEVID_405GP, 0x44, 0x00);
+               }
+
+               if (loopcount++ > countmax) {
+                       /* Abort if ctrl-c was pressed */
+                       if (ctrlc()) {
+                               puts("\nAbort\n");
+                               return 0;
+                       }
+
+                       putc('.');
+
+                       loopcount = 0;
+               }
+       }
+
+       return 0;
+}
+U_BOOT_CMD(
+       writepci,       4,      1,      do_writepci,
+       "writepci - Write some data to pcibus\n",
+       "<addr> <size>\n"
+       "        - Write some data to pcibus.\n"
+);
+
+#define PCI_CFGADDR        0xeec00000
+#define PCI_CFGDATA        0xeec00004
+
+int ibmPciConfigWrite
+(
+       int offset,     /* offset into the configuration space */
+       int width,      /* data width                          */
+       unsigned int data       /* data to be written                  */
+       )
+{
+       /*
+        * Write config register address to the PCI config address register
+        * bit 31 must be 1 and bits 1:0 must be 0 (note LE bit notation)
+        */
+       out32r(PCI_CFGADDR, 0x80000000 | (offset & 0xFFFFFFFC));
+
+#if 0 /* test-only */
+       ppcSync();
+#endif
+
+       /*
+        * Write value to be written to the PCI config data register
+        */
+       switch ( width ) {
+       case 1: out32r(PCI_CFGDATA | (offset & 0x3), (unsigned char)(data & 0xFF));
+               break;
+       case 2: out32r(PCI_CFGDATA | (offset & 0x3), (unsigned short)(data & 0xFFFF));
+               break;
+       case 4: out32r(PCI_CFGDATA | (offset & 0x3), data);
+               break;
+       }
+
+       return (0);
+}
+
+int do_writepci2(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
+{
+       unsigned int addr;
+       unsigned int size;
+       unsigned int countmax;
+       int max;
+       volatile unsigned long *ptr;
+       volatile unsigned long val;
+       int loopcount = 0;
+
+       addr = simple_strtol (argv[1], NULL, 16);
+       size = simple_strtol (argv[2], NULL, 16);
+       countmax = simple_strtol (argv[3], NULL, 16);
+       if (countmax == 0)
+               countmax = 1000;
+
+       do_getplb(NULL, 0, 0, NULL);
+
+#if 0
+       out32r(PMM0LA, 0);
+       out32r(PMM0PCILA, 0);
+       out32r(PMM0PCIHA, 0);
+       out32r(PMM0MA, 0);
+       out32r(PMM1LA, PCI_ADDR);
+       out32r(PMM1PCILA, addr & 0xff000000);
+       out32r(PMM1PCIHA, 0x00000000);
+       out32r(PMM1MA, 0xff000001);
+#endif
+
+       printf("PMM1LA    =%08lx\n", in32r(PMM1LA));
+       printf("PMM1MA    =%08lx\n", in32r(PMM1MA));
+       printf("PMM1PCILA =%08lx\n", in32r(PMM1PCILA));
+       printf("PMM1PCIHA =%08lx\n", in32r(PMM1PCIHA));
+
+       addr = PCI_ADDR | (addr & 0x00ffffff);
+       printf("\nWriting at addr %08x, size %08x (countmax=%x)\n", addr, size, countmax);
+
+       max = size >> 2;
+
+       pci_write_config_word(PCIDEVID_405GP, 0x04, 0x0106); /* write command reg */
+
+       while (1) {
+
+               /*
+                * Write one values to host via pci busmastering
+                */
+               ptr = (volatile unsigned long *)addr;
+               *ptr = 0x01234567;
+
+               /*
+                * Read one value back
+                */
+               ptr = (volatile unsigned long *)addr;
+               val = *ptr;
+
+               /*
+                * One pci config write
+                */
+/*             pci_write_config_byte(PCIDEVID_405GP, 0x44, 0x00); */
+/*             ibmPciConfigWrite(0x44, 1, 0x00); */
+               ibmPciConfigWrite(0x2e, 2, 0x1234); /* subsystem id */
+
+               if (loopcount++ > countmax) {
+                       /* Abort if ctrl-c was pressed */
+                       if (ctrlc()) {
+                               puts("\nAbort\n");
+                               return 0;
+                       }
+
+                       putc('.');
+
+                       loopcount = 0;
+               }
+       }
+
+       return 0;
+}
+U_BOOT_CMD(
+       writepci2,      4,      1,      do_writepci2,
+       "writepci2- Write some data to pcibus\n",
+       "<addr> <size>\n"
+       "        - Write some data to pcibus.\n"
+);
+
+int do_writepci22(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
+{
+       unsigned int addr;
+       unsigned int size;
+       unsigned int countmax = 0;
+       volatile unsigned long *ptr;
+       volatile unsigned long val;
+
+       addr = simple_strtol (argv[1], NULL, 16);
+       size = simple_strtol (argv[2], NULL, 16);
+
+       addr = PCI_ADDR | (addr & 0x00ffffff);
+       printf("\nWriting at addr %08x, size %08x (countmax=%x)\n", addr, size, countmax);
+       pci_write_config_word(PCIDEVID_405GP, 0x04, 0x0106); /* write command reg */
+
+       while (1) {
+
+               /*
+                * Write one values to host via pci busmastering
+                */
+               ptr = (volatile unsigned long *)addr;
+               *ptr = 0x01234567;
+
+               /*
+                * Read one value back
+                */
+               ptr = (volatile unsigned long *)addr;
+               val = *ptr;
+
+               /*
+                * One pci config write
+                */
+               ibmPciConfigWrite(0x2e, 2, 0x1234); /* subsystem id */
+       }
+
+       return 0;
+}
+U_BOOT_CMD(
+       writepci22,     4,      1,      do_writepci22,
+       "writepci22- Write some data to pcibus\n",
+       "<addr> <size>\n"
+       "        - Write some data to pcibus.\n"
+);
+
+int ibmPciConfigWrite3
+(
+       int offset,     /* offset into the configuration space */
+       int width,      /* data width                          */
+       unsigned int data       /* data to be written                  */
+       )
+{
+       /*
+        * Write config register address to the PCI config address register
+        * bit 31 must be 1 and bits 1:0 must be 0 (note LE bit notation)
+        */
+       out32r(PCI_CFGADDR, 0x80000000 | (offset & 0xFFFFFFFC));
+
+#if 1 /* test-only */
+       ppcSync();
+#endif
+
+       /*
+        * Write value to be written to the PCI config data register
+        */
+       switch ( width ) {
+       case 1: out32r(PCI_CFGDATA | (offset & 0x3), (unsigned char)(data & 0xFF));
+               break;
+       case 2: out32r(PCI_CFGDATA | (offset & 0x3), (unsigned short)(data & 0xFFFF));
+               break;
+       case 4: out32r(PCI_CFGDATA | (offset & 0x3), data);
+               break;
+       }
+
+       return (0);
+}
+
+int do_writepci3(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
+{
+       unsigned int addr;
+       unsigned int size;
+       unsigned int countmax;
+       int max;
+       volatile unsigned long *ptr;
+       volatile unsigned long val;
+       int loopcount = 0;
+
+       addr = simple_strtol (argv[1], NULL, 16);
+       size = simple_strtol (argv[2], NULL, 16);
+       countmax = simple_strtol (argv[3], NULL, 16);
+       if (countmax == 0)
+               countmax = 1000;
+
+       do_getplb(NULL, 0, 0, NULL);
+
+#if 0
+       out32r(PMM0LA, 0);
+       out32r(PMM0PCILA, 0);
+       out32r(PMM0PCIHA, 0);
+       out32r(PMM0MA, 0);
+       out32r(PMM1LA, PCI_ADDR);
+       out32r(PMM1PCILA, addr & 0xff000000);
+       out32r(PMM1PCIHA, 0x00000000);
+       out32r(PMM1MA, 0xff000001);
+#endif
+
+       printf("PMM1LA    =%08lx\n", in32r(PMM1LA));
+       printf("PMM1MA    =%08lx\n", in32r(PMM1MA));
+       printf("PMM1PCILA =%08lx\n", in32r(PMM1PCILA));
+       printf("PMM1PCIHA =%08lx\n", in32r(PMM1PCIHA));
+
+       addr = PCI_ADDR | (addr & 0x00ffffff);
+       printf("\nWriting at addr %08x, size %08x (countmax=%x)\n", addr, size, countmax);
+
+       max = size >> 2;
+
+       pci_write_config_word(PCIDEVID_405GP, 0x04, 0x0106); /* write command reg */
+
+       while (1) {
+
+               /*
+                * Write one values to host via pci busmastering
+                */
+               ptr = (volatile unsigned long *)addr;
+               *ptr = 0x01234567;
+
+               /*
+                * Read one value back
+                */
+               ptr = (volatile unsigned long *)addr;
+               val = *ptr;
+
+               /*
+                * One pci config write
+                */
+/*             pci_write_config_byte(PCIDEVID_405GP, 0x44, 0x00); */
+/*             ibmPciConfigWrite(0x44, 1, 0x00); */
+               ibmPciConfigWrite3(0x2e, 2, 0x1234); /* subsystem id */
+
+               if (loopcount++ > countmax) {
+                       /* Abort if ctrl-c was pressed */
+                       if (ctrlc()) {
+                               puts("\nAbort\n");
+                               return 0;
+                       }
+
+                       putc('.');
+
+                       loopcount = 0;
+               }
+       }
+
+       return 0;
+}
+U_BOOT_CMD(
+       writepci3,      4,      1,      do_writepci3,
+       "writepci3- Write some data to pcibus\n",
+       "<addr> <size>\n"
+       "        - Write some data to pcibus.\n"
+);
+
+
+#define SECTOR_SIZE    32              /* 32 byte cache line */
+#define SECTOR_MASK    0x1F
+
+void my_flush_dcache(ulong lcl_addr, ulong count)
+{
+  unsigned int lcl_target;
+
+  /* promote to nearest cache sector */
+  lcl_target =  (lcl_addr + count + SECTOR_SIZE - 1) & ~SECTOR_MASK;
+  lcl_addr &= ~SECTOR_MASK;
+  while (lcl_addr != lcl_target)
+    {
+      /*      ppcDcbf((void *)lcl_addr);*/
+      __asm__("dcbf 0,%0": :"r" (lcl_addr));
+      lcl_addr += SECTOR_SIZE;
+    }
+  __asm__("sync");             /* Always flush prefetch queue in any case */
+}
+
+int do_writepci_cache(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
+{
+       unsigned int addr;
+       unsigned int size;
+       unsigned int countmax;
+       int i;
+       volatile unsigned long *ptr;
+       volatile unsigned long val;
+       int loopcount = 0;
+
+       addr = simple_strtol (argv[1], NULL, 16);
+       size = simple_strtol (argv[2], NULL, 16);
+       countmax = simple_strtol (argv[3], NULL, 16);
+       if (countmax == 0)
+               countmax = 1000;
+
+       do_getplb(NULL, 0, 0, NULL);
+
+#if 0
+       out32r(PMM0LA, 0);
+       out32r(PMM0PCILA, 0);
+       out32r(PMM0PCIHA, 0);
+       out32r(PMM0MA, 0);
+       out32r(PMM1LA, PCI_ADDR);
+       out32r(PMM1PCILA, addr & 0xff000000);
+       out32r(PMM1PCIHA, 0x00000000);
+       out32r(PMM1MA, 0xff000001);
+#endif
+
+       printf("PMM1LA    =%08lx\n", in32r(PMM1LA));
+       printf("PMM1MA    =%08lx\n", in32r(PMM1MA));
+       printf("PMM1PCILA =%08lx\n", in32r(PMM1PCILA));
+       printf("PMM1PCIHA =%08lx\n", in32r(PMM1PCIHA));
+
+       addr = PCI_ADDR | (addr & 0x00ffffff);
+       printf("\nWriting at addr %08x, size %08x (countmax=%x)\n", addr, size, countmax);
+
+       pci_write_config_word(PCIDEVID_405GP, 0x04, 0x0106); /* write command reg */
+
+       i = 0;
+
+       /*
+        * Set pci region as cachable
+        */
+       ppcSync();
+       __asm__ volatile ("     addis   4,0,0x0000 ");
+       __asm__ volatile ("     addi    4,4,0x0080 ");
+       __asm__ volatile ("     mtdccr  4 ");
+       ppcSync();
+
+       while (1) {
+
+               /*
+                * Write one values to host via pci busmastering
+                */
+               ptr = (volatile unsigned long *)addr;
+               printf("A\n"); /* test-only */
+               *ptr++ = i++;
+               *ptr++ = i++;
+               *ptr++ = i++;
+               *ptr++ = i++;
+               *ptr++ = i++;
+               *ptr++ = i++;
+               *ptr++ = i++;
+               *ptr++ = i++;
+               printf("B\n"); /* test-only */
+               my_flush_dcache(addr, 32);
+               printf("C\n"); /* test-only */
+
+               /*
+                * Read one value back
+                */
+               ptr = (volatile unsigned long *)addr;
+               val = *ptr;
+               printf("D\n"); /* test-only */
+
+               /*
+                * One pci config write
+                */
+/*             pci_write_config_byte(PCIDEVID_405GP, 0x44, 0x00); */
+/*             ibmPciConfigWrite(0x44, 1, 0x00); */
+               ibmPciConfigWrite3(0x2e, 2, 0x1234); /* subsystem id */
+               printf("E\n"); /* test-only */
+
+               if (loopcount++ > countmax) {
+                       /* Abort if ctrl-c was pressed */
+                       if (ctrlc()) {
+                               puts("\nAbort\n");
+                               return 0;
+                       }
+
+                       putc('.');
+
+                       loopcount = 0;
+               }
+       }
+
+       return 0;
+}
+U_BOOT_CMD(
+       writepci_cache, 4,      1,      do_writepci_cache,
+       "writepci_cache - Write some data to pcibus\n",
+       "<addr> <size>\n"
+       "        - Write some data to pcibus.\n"
+);
+
+int do_savepci(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
+{
+       unsigned int *ptr;
+       int i;
+
+       /*
+        * Save own pci configuration in PRAM
+        */
+       memset((char *)PCI_REGS_ADDR, 0, PCI_REGS_LEN);
+       ptr = (unsigned int *)PCI_REGS_ADDR + 1;
+       for (i=0; i<0x40; i+=4) {
+               pci_read_config_dword(PCIDEVID_405GP, i, ptr++);
        }
+       ptr = (unsigned int *)PCI_REGS_ADDR;
+       *ptr = crc32(0, (uchar *)PCI_REGS_ADDR+4, PCI_REGS_LEN-4);
+
+       printf("\nStoring PCI Configuration Regs...\n");
 
        return 0;
 }
+U_BOOT_CMD(
+       savepci,        4,      1,      do_savepci,
+       "savepci  - Save all pci regs\n",
+       "<addr> <size>\n"
+       "        - Write some data to pcibus.\n"
+);
 
+int do_restorepci(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
+{
+       unsigned int *ptr;
+       int i;
+
+       /*
+        * Rewrite pci config regs (only after soft-reset with magic set)
+        */
+       ptr = (unsigned int *)PCI_REGS_ADDR;
+       if (crc32(0, (uchar *)PCI_REGS_ADDR+4, PCI_REGS_LEN-4) == *ptr) {
+               puts("Restoring PCI Configurations Regs!\n");
+               ptr = (unsigned int *)PCI_REGS_ADDR + 1;
+               for (i=0; i<0x40; i+=4) {
+                       pci_write_config_dword(PCIDEVID_405GP, i, *ptr++);
+               }
+       }
+       mtdcr(uicsr, 0xFFFFFFFF);        /* clear all ints */
+
+       return 0;
+}
+U_BOOT_CMD(
+       restorepci,     4,      1,      do_restorepci,
+       "restorepci  - Restore all pci regs\n",
+       "<addr> <size>\n"
+       "        - Write some data to pcibus.\n"
+);
+
+
+extern void write_without_sync(void);
+extern void write_with_sync(void);
+extern void write_with_less_sync(void);
+extern void write_with_more_sync(void);
+
+/*
+ * code from IBM-PPCSUPP
+ */
+int do_writeibm1(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
+{
+       pci_write_config_word(PCIDEVID_405GP, 0x04, 0x0106); /* write command reg */
+
+       write_without_sync();
+
+       return 0;
+}
+U_BOOT_CMD(
+       writeibm1,      4,      1,      do_writeibm1,
+       "writeibm1- Write some data to pcibus (without sync)\n",
+       "<addr> <size>\n"
+       "        - Write some data to pcibus.\n"
+);
+
+int do_writeibm2(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
+{
+       pci_write_config_word(PCIDEVID_405GP, 0x04, 0x0106); /* write command reg */
+
+       write_with_sync();
+
+       return 0;
+}
+U_BOOT_CMD(
+       writeibm2,      4,      1,      do_writeibm2,
+       "writeibm2- Write some data to pcibus (with sync)\n",
+       "<addr> <size>\n"
+       "        - Write some data to pcibus.\n"
+);
+
+int do_writeibm22(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
+{
+       pci_write_config_word(PCIDEVID_405GP, 0x04, 0x0106); /* write command reg */
+
+       write_with_less_sync();
+
+       return 0;
+}
+U_BOOT_CMD(
+       writeibm22,     4,      1,      do_writeibm22,
+       "writeibm22- Write some data to pcibus (with less sync)\n",
+       "<addr> <size>\n"
+       "        - Write some data to pcibus.\n"
+);
+
+int do_writeibm3(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
+{
+       pci_write_config_word(PCIDEVID_405GP, 0x04, 0x0106); /* write command reg */
+
+       write_with_more_sync();
+
+       return 0;
+}
+U_BOOT_CMD(
+       writeibm3,      4,      1,      do_writeibm3,
+       "writeibm3- Write some data to pcibus (with more sync)\n",
+       "<addr> <size>\n"
+       "        - Write some data to pcibus.\n"
+);
 #endif