Merge with /home/wd/git/u-boot/custodian/u-boot-mpc85xx
[platform/kernel/u-boot.git] / cpu / mpc86xx / cpu.c
index e21b051..a33acfe 100644 (file)
@@ -1,6 +1,6 @@
 /*
- * Copyright 2004 Freescale Semiconductor
- * Jeff Brown (jeffrey@freescale.com)
+ * Copyright 2006 Freescale Semiconductor
+ * Jeff Brown
  * Srikanth Srinivasan (srikanth.srinivasan@freescale.com)
  *
  * See file CREDITS for list of people who contributed to this
 #include <ft_build.h>
 #endif
 
-#include "../board/mpc8641hpcn/pixis.h"
-
-
-static __inline__ unsigned long get_dbat3u (void)
-{
-       unsigned long dbat3u;
-       asm volatile("mfspr %0, 542" : "=r" (dbat3u) :);
-       return dbat3u;
-}
-
-static __inline__ unsigned long get_dbat3l (void)
-{
-       unsigned long dbat3l;
-       asm volatile("mfspr %0, 543" : "=r" (dbat3l) :);
-       return dbat3l;
-}
-
-static __inline__ unsigned long get_msr (void)
-{
-       unsigned long msr;
-       asm volatile("mfmsr %0" : "=r" (msr) :);
-       return msr;
-}
-
-
-int checkcpu (void)
+int
+checkcpu(void)
 {
        sys_info_t sysinfo;
        uint pvr, svr;
@@ -74,16 +50,15 @@ int checkcpu (void)
        minor = PVR_MIN(pvr);
 
        puts("CPU:\n");
-
-       printf("    Core: ");
+       puts("    Core: ");
 
        switch (ver) {
        case PVR_VER(PVR_86xx):
-           puts("E600");
-           break;
+               puts("E600");
+               break;
        default:
-           puts("Unknown");
-           break;
+               puts("Unknown");
+               break;
        }
        printf(", Version: %d.%d, (0x%08x)\n", major, minor, pvr);
 
@@ -95,11 +70,12 @@ int checkcpu (void)
        puts("    System: ");
        switch (ver) {
        case SVR_8641:
-               puts("8641");
-               break;
-       case SVR_8641D:
+           if (SVR_SUBVER(svr) == 1) {
                puts("8641D");
-               break;
+           } else {
+               puts("8641");
+           }
+           break;
        default:
                puts("Unknown");
                break;
@@ -117,10 +93,10 @@ int checkcpu (void)
        lcrr = CFG_LBC_LCRR;
 #else
        {
-           volatile immap_t *immap = (immap_t *)CFG_IMMR;
-           volatile ccsr_lbc_t *lbc= &immap->im_lbc;
+               volatile immap_t *immap = (immap_t *) CFG_IMMR;
+               volatile ccsr_lbc_t *lbc = &immap->im_lbc;
 
-           lcrr = lbc->lcrr;
+               lcrr = lbc->lcrr;
        }
 #endif
        clkdiv = lcrr & 0x0f;
@@ -131,26 +107,25 @@ int checkcpu (void)
                printf("    LBC: unknown (lcrr: 0x%08x)\n", lcrr);
        }
 
-       printf("    L2: ");
+       puts("    L2: ");
        if (get_l2cr() & 0x80000000)
-               printf("Enabled\n");
+               puts("Enabled\n");
        else
-               printf("Disabled\n");
+               puts("Disabled\n");
 
        return 0;
 }
 
 
-/* -------------------------------------------------------------------- */
-
 static inline void
 soft_restart(unsigned long addr)
 {
-
 #ifndef CONFIG_MPC8641HPCN
 
-       /* SRR0 has system reset vector, SRR1 has default MSR value */
-       /* rfi restores MSR from SRR1 and sets the PC to the SRR0 value */
+       /*
+        * SRR0 has system reset vector, SRR1 has default MSR value
+        * rfi restores MSR from SRR1 and sets the PC to the SRR0 value
+        */
 
        __asm__ __volatile__ ("mtspr    26, %0"         :: "r" (addr));
        __asm__ __volatile__ ("li       4, (1 << 6)"    ::: "r4");
@@ -158,9 +133,12 @@ soft_restart(unsigned long addr)
        __asm__ __volatile__ ("rfi");
 
 #else /* CONFIG_MPC8641HPCN */
-       out8(PIXIS_BASE+PIXIS_RST,0);
+
+       out8(PIXIS_BASE + PIXIS_RST, 0);
+
 #endif /* !CONFIG_MPC8641HPCN */
-       while(1);       /* not reached */
+
+       while (1) ;             /* not reached */
 }
 
 
@@ -170,12 +148,10 @@ soft_restart(unsigned long addr)
 void
 do_reset(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
 {
-       char cmd;
-       ulong addr, val;
-       ulong corepll;
+#ifndef CONFIG_MPC8641HPCN
 
 #ifdef CFG_RESET_ADDRESS
-       addr = CFG_RESET_ADDRESS;
+       ulong addr = CFG_RESET_ADDRESS;
 #else
        /*
         * note: when CFG_MONITOR_BASE points to a RAM address,
@@ -183,11 +159,9 @@ do_reset(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
         * address. Better pick an address known to be invalid on your
         * system and assign it to CFG_RESET_ADDRESS.
         */
-       addr = CFG_MONITOR_BASE - sizeof (ulong);
+       ulong addr = CFG_MONITOR_BASE - sizeof(ulong);
 #endif
 
-#ifndef CONFIG_MPC8641HPCN
-
        /* flush and disable I/D cache */
        __asm__ __volatile__ ("mfspr    3, 1008"        ::: "r3");
        __asm__ __volatile__ ("ori      5, 5, 0xcc00"   ::: "r5");
@@ -205,99 +179,21 @@ do_reset(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
 
 #else /* CONFIG_MPC8641HPCN */
 
-       if (argc > 1) {
-               cmd = argv[1][1];
-               switch(cmd) {
-               case 'f':    /* reset with frequency changed */
-                       if (argc < 5)
-                               goto my_usage;
-                       read_from_px_regs(0);
-
-                       val = set_px_sysclk(simple_strtoul(argv[2],NULL,10));
-
-                       corepll = strfractoint(argv[3]);
-                       val = val + set_px_corepll(corepll);
-                       val = val + set_px_mpxpll(simple_strtoul(argv[4],
-                                                                NULL, 10));
-                       if (val == 3) {
-                               printf("Setting registers VCFGEN0 and VCTL\n");
-                               read_from_px_regs(1);
-                               printf("Resetting board with values from VSPEED0, VSPEED1, VCLKH, and VCLKL ....\n");
-                               set_px_go();
-                       } else
-                               goto my_usage;
-
-                       while (1); /* Not reached */
-
-               case 'l':
-                       if (argv[2][1] == 'f') {
-                               read_from_px_regs(0);
-                               read_from_px_regs_altbank(0);
-                               /* reset with frequency changed */
-                               val = set_px_sysclk(simple_strtoul(argv[3],NULL,10));
-
-                               corepll = strfractoint(argv[4]);
-                               val = val + set_px_corepll(corepll);
-                               val = val + set_px_mpxpll(simple_strtoul(argv[5],NULL,10));
-                               if (val == 3) {
-                                       printf("Setting registers VCFGEN0, VCFGEN1, VBOOT, and VCTL\n");
-                                       set_altbank();
-                                       read_from_px_regs(1);
-                                       read_from_px_regs_altbank(1);
-                                       printf("Enabling watchdog timer on the FPGA and resetting board with values from VSPEED0, VSPEED1, VCLKH, and VCLKL to boot from the other bank ....\n");
-                                       set_px_go_with_watchdog();
-                               } else
-                                       goto my_usage;
-
-                               while(1); /* Not reached */
-                       } else if(argv[2][1] == 'd'){
-                               /* Reset from next bank without changing frequencies but with watchdog timer enabled */
-                               read_from_px_regs(0);
-                               read_from_px_regs_altbank(0);
-                               printf("Setting registers VCFGEN1, VBOOT, and VCTL\n");
-                               set_altbank();
-                               read_from_px_regs_altbank(1);
-                               printf("Enabling watchdog timer on the FPGA and resetting board to boot from the other bank....\n");
-                               set_px_go_with_watchdog();
-                               while(1); /* Not reached */
-                       } else {
-                               /* Reset from next bank without changing frequency and without watchdog timer enabled */
-                               read_from_px_regs(0);
-                               read_from_px_regs_altbank(0);
-                               if(argc > 2)
-                                       goto my_usage;
-                               printf("Setting registers VCFGNE1, VBOOT, and VCTL\n");
-                               set_altbank();
-                               read_from_px_regs_altbank(1);
-                               printf("Resetting board to boot from the other bank....\n");
-                               set_px_go();
-                       }
-
-               default:
-                       goto my_usage;
-               }
-
-my_usage:
-               printf("\nUsage: reset cf <SYSCLK freq> <COREPLL ratio> <MPXPLL ratio>\n");
-               printf("       reset altbank [cf <SYSCLK freq> <COREPLL ratio> <MPXPLL ratio>]\n");
-               printf("For example:   reset cf 40 2.5 10\n");
-               printf("See MPC8641HPCN Design Workbook for valid values of command line parameters.\n");
-               return;
-       } else
-               out8(PIXIS_BASE+PIXIS_RST,0);
+       out8(PIXIS_BASE + PIXIS_RST, 0);
 
 #endif /* !CONFIG_MPC8641HPCN */
 
-       while(1);       /* not reached */
+       while (1) ;             /* not reached */
 }
 
 
 /*
  * Get timebase clock frequency
  */
-unsigned long get_tbclk(void)
+unsigned long
+get_tbclk(void)
 {
-       sys_info_t  sys_info;
+       sys_info_t sys_info;
 
        get_sys_info(&sys_info);
        return (sys_info.freqSystemBus + 3L) / 4L;
@@ -313,9 +209,10 @@ watchdog_reset(void)
 
 
 #if defined(CONFIG_DDR_ECC)
-void dma_init(void)
+void
+dma_init(void)
 {
-       volatile immap_t *immap = (immap_t *)CFG_IMMR;
+       volatile immap_t *immap = (immap_t *) CFG_IMMR;
        volatile ccsr_dma_t *dma = &immap->im_dma;
 
        dma->satr0 = 0x00040000;
@@ -323,26 +220,28 @@ void dma_init(void)
        asm("sync; isync");
 }
 
-uint dma_check(void)
+uint
+dma_check(void)
 {
-       volatile immap_t *immap = (immap_t *)CFG_IMMR;
+       volatile immap_t *immap = (immap_t *) CFG_IMMR;
        volatile ccsr_dma_t *dma = &immap->im_dma;
        volatile uint status = dma->sr0;
 
        /* While the channel is busy, spin */
-       while((status & 4) == 4) {
+       while ((status & 4) == 4) {
                status = dma->sr0;
        }
 
        if (status != 0) {
-               printf ("DMA Error: status = %x\n", status);
+               printf("DMA Error: status = %x\n", status);
        }
        return status;
 }
 
-int dma_xfer(void *dest, uint count, void *src)
+int
+dma_xfer(void *dest, uint count, void *src)
 {
-       volatile immap_t *immap = (immap_t *)CFG_IMMR;
+       volatile immap_t *immap = (immap_t *) CFG_IMMR;
        volatile ccsr_dma_t *dma = &immap->im_dma;
 
        dma->dar0 = (uint) dest;
@@ -359,7 +258,8 @@ int dma_xfer(void *dest, uint count, void *src)
 
 
 #ifdef CONFIG_OF_FLAT_TREE
-void ft_cpu_setup(void *blob, bd_t *bd)
+void
+ft_cpu_setup(void *blob, bd_t *bd)
 {
        u32 *p;
        ulong clock;
@@ -379,23 +279,39 @@ void ft_cpu_setup(void *blob, bd_t *bd)
                *p = cpu_to_be32(clock);
 
 #if defined(CONFIG_MPC86XX_TSEC1)
-       p = ft_get_prop(blob, "/" OF_SOC "/ethernet@24000/address", &len);
-       memcpy(p, bd->bi_enetaddr, 6);
+       p = ft_get_prop(blob, "/" OF_SOC "/ethernet@24000/mac-address", &len);
+       if (p != NULL)
+               memcpy(p, bd->bi_enetaddr, 6);
+       p = ft_get_prop(blob, "/" OF_SOC "/ethernet@24000/local-mac-address", &len);
+       if (p)
+               memcpy(p, bd->bi_enetaddr, 6);
 #endif
 
 #if defined(CONFIG_MPC86XX_TSEC2)
-       p = ft_get_prop(blob, "/" OF_SOC "/ethernet@25000/address", &len);
-       memcpy(p, bd->bi_enet1addr, 6);
+       p = ft_get_prop(blob, "/" OF_SOC "/ethernet@25000/mac-address", &len);
+       if (p != NULL)
+               memcpy(p, bd->bi_enet1addr, 6);
+       p = ft_get_prop(blob, "/" OF_SOC "/ethernet@25000/local-mac-address", &len);
+       if (p != NULL)
+               memcpy(p, bd->bi_enet1addr, 6);
 #endif
 
 #if defined(CONFIG_MPC86XX_TSEC3)
-       p = ft_get_prop(blob, "/" OF_SOC "/ethernet@26000/address", &len);
-       memcpy(p, bd->bi_enet2addr, 6);
+       p = ft_get_prop(blob, "/" OF_SOC "/ethernet@26000/mac-address", &len);
+       if (p != NULL)
+               memcpy(p, bd->bi_enet2addr, 6);
+       p = ft_get_prop(blob, "/" OF_SOC "/ethernet@26000/local-mac-address", &len);
+       if (p != NULL)
+               memcpy(p, bd->bi_enet2addr, 6);
 #endif
 
 #if defined(CONFIG_MPC86XX_TSEC4)
-       p = ft_get_prop(blob, "/" OF_SOC "/ethernet@27000/address", &len);
-        memcpy(p, bd->bi_enet3addr, 6);
+       p = ft_get_prop(blob, "/" OF_SOC "/ethernet@27000/mac-address", &len);
+       if (p != NULL)
+               memcpy(p, bd->bi_enet3addr, 6);
+       p = ft_get_prop(blob, "/" OF_SOC "/ethernet@27000/local-mac-address", &len);
+       if (p != NULL)
+               memcpy(p, bd->bi_enet3addr, 6);
 #endif
 
 }