/* * Copyright 2004 Freescale Semiconductor * Jeff Brown (jeffrey@freescale.com) * Srikanth Srinivasan (srikanth.srinivasan@freescale.com) * * See file CREDITS for list of people who contributed to this * project. * * This program is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public License as * published by the Free Software Foundation; either version 2 of * the License, or (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 59 Temple Place, Suite 330, Boston, * MA 02111-1307 USA */ #include #include #include #include #include #if defined(CONFIG_OF_FLAT_TREE) #include #endif // SS: For debug only, remove after use 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; } extern unsigned long get_board_sys_clk(ulong dummy); int checkcpu (void) { sys_info_t sysinfo; uint pvr, svr; uint ver; uint major, minor; uint lcrr; /* local bus clock ratio register */ uint clkdiv; /* clock divider portion of lcrr */ puts("Freescale PowerPC\n"); pvr = get_pvr(); ver = PVR_VER(pvr); major = PVR_MAJ(pvr); minor = PVR_MIN(pvr); puts ("CPU:\n"); printf(" Core: "); switch (ver) { case PVR_VER(PVR_86xx): puts("E600"); break; default: puts("Unknown"); break; } printf(", Version: %d.%d, (0x%08x)\n", major, minor, pvr); svr = get_svr(); ver = SVR_VER(svr); major = SVR_MAJ(svr); minor = SVR_MIN(svr); puts(" System: "); switch (ver) { case SVR_8641: puts("8641"); break; case SVR_8641D: puts("8641D"); break; default: puts("Unknown"); break; } printf(", Version: %d.%d, (0x%08x)\n", major, minor, svr); get_sys_info(&sysinfo); puts(" Clocks: "); printf("CPU:%4lu MHz, ", sysinfo.freqProcessor / 1000000); printf("MPX:%4lu MHz, ", sysinfo.freqSystemBus / 1000000); printf("DDR:%4lu MHz, ", sysinfo.freqSystemBus / 2000000); #if defined(CFG_LBC_LCRR) lcrr = CFG_LBC_LCRR; #else { volatile immap_t *immap = (immap_t *)CFG_IMMR; volatile ccsr_lbc_t *lbc= &immap->im_lbc; lcrr = lbc->lcrr; } #endif clkdiv = lcrr & 0x0f; if (clkdiv == 2 || clkdiv == 4 || clkdiv == 8) { printf("LBC:%4lu MHz\n", sysinfo.freqSystemBus / 1000000 / clkdiv); } else { printf(" LBC: unknown (lcrr: 0x%08x)\n", lcrr); } printf(" L2: "); if (get_l2cr() & 0x80000000) printf("Enabled\n"); else printf("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 */ __asm__ __volatile__ ("mtspr 26, %0" :: "r" (addr)); __asm__ __volatile__ ("li 4, (1 << 6)" ::: "r4"); __asm__ __volatile__ ("mtspr 27, 4"); __asm__ __volatile__ ("rfi"); #else /* CONFIG_MPC8641HPCN */ out8(PIXIS_BASE+PIXIS_RST,0); #endif /* !CONFIG_MPC8641HPCN */ while(1); /* not reached */ } #ifdef CONFIG_MPC8641HPCN int set_px_sysclk(ulong sysclk) { u8 sysclk_s, sysclk_r, sysclk_v, vclkh, vclkl, sysclk_aux,tmp; /* Per table 27, page 58 of MPC8641HPCN spec*/ switch(sysclk) { case 33: sysclk_s = 0x04; sysclk_r = 0x04; sysclk_v = 0x07; sysclk_aux = 0x00; break; case 40: sysclk_s = 0x01; sysclk_r = 0x1F; sysclk_v = 0x20; sysclk_aux = 0x01; break; case 50: sysclk_s = 0x01; sysclk_r = 0x1F; sysclk_v = 0x2A; sysclk_aux = 0x02; break; case 66: sysclk_s = 0x01; sysclk_r = 0x04; sysclk_v = 0x04; sysclk_aux = 0x03; break; case 83: sysclk_s = 0x01; sysclk_r = 0x1F; sysclk_v = 0x4B; sysclk_aux = 0x04; break; case 100: sysclk_s = 0x01; sysclk_r = 0x1F; sysclk_v = 0x5C; sysclk_aux = 0x05; break; case 134: sysclk_s = 0x06; sysclk_r = 0x1F; sysclk_v = 0x3B; sysclk_aux = 0x06; break; case 166: sysclk_s = 0x06; sysclk_r = 0x1F; sysclk_v = 0x4B; sysclk_aux = 0x07; break; default: printf("Unsupported SYSCLK frequency.\n"); return 0; } vclkh = (sysclk_s << 5) | sysclk_r ; vclkl = sysclk_v; out8(PIXIS_BASE+PIXIS_VCLKH,vclkh); out8(PIXIS_BASE+PIXIS_VCLKL,vclkl); out8(PIXIS_BASE+PIXIS_AUX,sysclk_aux); return 1; } int set_px_mpxpll(ulong mpxpll) { u8 tmp; u8 val; switch(mpxpll) { case 2: case 4: case 6: case 8: case 10: case 12: case 14: case 16: val = (u8)mpxpll; break; default: printf("Unsupported MPXPLL ratio.\n"); return 0; } tmp = in8(PIXIS_BASE+PIXIS_VSPEED1); tmp = (tmp & 0xF0) | (val & 0x0F); out8(PIXIS_BASE+PIXIS_VSPEED1,tmp); return 1; } int set_px_corepll(ulong corepll) { u8 tmp; u8 val; switch((int)corepll) { case 20: val = 0x08; break; case 25: val = 0x0C; break; case 30: val = 0x10; break; case 35: val = 0x1C; break; case 40: val = 0x14; break; case 45: val = 0x0E; break; default: printf("Unsupported COREPLL ratio.\n"); return 0; } tmp = in8(PIXIS_BASE+PIXIS_VSPEED0); tmp = (tmp & 0xE0) | (val & 0x1F); out8(PIXIS_BASE+PIXIS_VSPEED0,tmp); return 1; } void read_from_px_regs(int set) { u8 tmp, mask = 0x1C; tmp = in8(PIXIS_BASE+PIXIS_VCFGEN0); if (set) tmp = tmp | mask; else tmp = tmp & ~mask; out8(PIXIS_BASE+PIXIS_VCFGEN0,tmp); } void read_from_px_regs_altbank(int set) { u8 tmp, mask = 0x04; tmp = in8(PIXIS_BASE+PIXIS_VCFGEN1); if (set) tmp = tmp | mask; else tmp = tmp & ~mask; out8(PIXIS_BASE+PIXIS_VCFGEN1,tmp); } void set_altbank(void) { u8 tmp; tmp = in8(PIXIS_BASE+PIXIS_VBOOT); tmp ^= 0x40; out8(PIXIS_BASE+PIXIS_VBOOT,tmp); } void set_px_go(void) { u8 tmp; tmp = in8(PIXIS_BASE+PIXIS_VCTL); tmp = tmp & 0x1E; out8(PIXIS_BASE+PIXIS_VCTL,tmp); tmp = in8(PIXIS_BASE+PIXIS_VCTL); tmp = tmp | 0x01; out8(PIXIS_BASE+PIXIS_VCTL,tmp); } void set_px_go_with_watchdog(void) { u8 tmp; tmp = in8(PIXIS_BASE+PIXIS_VCTL); tmp = tmp & 0x1E; out8(PIXIS_BASE+PIXIS_VCTL,tmp); tmp = in8(PIXIS_BASE+PIXIS_VCTL); tmp = tmp | 0x09; out8(PIXIS_BASE+PIXIS_VCTL,tmp); } /* This function takes the non-integral cpu:mpx pll ratio * and converts it to an integer that can be used to assign * FPGA register values. * input: strptr i.e. argv[2] */ ulong strfractoint(uchar *strptr) { int i,j,retval,intarr_len=0, decarr_len=0, mulconst, no_dec=0; ulong intval =0, decval=0; uchar intarr[3], decarr[3]; /* Assign the integer part to intarr[] * If there is no decimal point i.e. * if the ratio is an integral value * simply create the intarr. */ i=0; while(strptr[i] != 46) { if(strptr[i] == 0) { no_dec = 1; break; /* Break from loop once the end of string is reached */ } intarr[i] = strptr[i]; i++; } intarr_len = i; /* Assign length of integer part to intarr_len*/ intarr[i] = '\0'; /* */ if(no_dec) { mulconst=10; /* Currently needed only for single digit corepll ratios */ decval = 0; } else { j=0; i++; /* Skipping the decimal point */ while ((strptr[i] > 47) && (strptr[i] < 58)) { decarr[j] = strptr[i]; i++; j++; } decarr_len = j; decarr[j] = '\0'; mulconst=1; for(i=0; i 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 /* Reset from next bank without changing frequencies */ { read_from_px_regs(0); read_from_px_regs_altbank(0); if(argc > 2) goto my_usage; 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 */ } default: goto my_usage; } my_usage: printf("\nUsage: reset cf \n"); printf(" reset altbank [cf ]\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); #endif /* !CONFIG_MPC8641HPCN */ while(1); /* not reached */ } /* ------------------------------------------------------------------------- */ /* * Get timebase clock frequency */ unsigned long get_tbclk(void) { sys_info_t sys_info; get_sys_info(&sys_info); return ((sys_info.freqSystemBus + 3L) / 4L); } /* ------------------------------------------------------------------------- */ #if defined(CONFIG_WATCHDOG) void watchdog_reset(void) { } #endif /* CONFIG_WATCHDOG */ /* ------------------------------------------------------------------------- */ #if defined(CONFIG_DDR_ECC) void dma_init(void) { volatile immap_t *immap = (immap_t *)CFG_IMMR; volatile ccsr_dma_t *dma = &immap->im_dma; dma->satr0 = 0x00040000; dma->datr0 = 0x00040000; asm("sync; isync"); return; } uint dma_check(void) { 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) { status = dma->sr0; } if (status != 0) { printf ("DMA Error: status = %x\n", status); } return status; } int dma_xfer(void *dest, uint count, void *src) { volatile immap_t *immap = (immap_t *)CFG_IMMR; volatile ccsr_dma_t *dma = &immap->im_dma; dma->dar0 = (uint) dest; dma->sar0 = (uint) src; dma->bcr0 = count; dma->mr0 = 0xf000004; asm("sync;isync"); dma->mr0 = 0xf000005; asm("sync;isync"); return dma_check(); } #endif /* CONFIG_DDR_ECC */ #ifdef CONFIG_OF_FLAT_TREE void ft_cpu_setup(void *blob, bd_t *bd) { u32 *p; ulong clock; int len; clock = bd->bi_busfreq; p = ft_get_prop(blob, "/cpus/" OF_CPU "/bus-frequency", &len); if (p != NULL) *p = cpu_to_be32(clock); p = ft_get_prop(blob, "/" OF_SOC "/serial@4500/clock-frequency", &len); if (p != NULL) *p = cpu_to_be32(clock); p = ft_get_prop(blob, "/" OF_SOC "/serial@4600/clock-frequency", &len); if (p != NULL) *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); #endif #if defined(CONFIG_MPC86XX_TSEC2) p = ft_get_prop(blob, "/" OF_SOC "/ethernet@25000/address", &len); 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); #endif #if defined(CONFIG_MPC86XX_TSEC4) p = ft_get_prop(blob, "/" OF_SOC "/ethernet@27000/address", &len); memcpy(p, bd->bi_enet3addr, 6); #endif } #endif