| * Martin Winistoerfer, martinwinistoerfer@gmx.ch. |
| * SPDX-License-Identifier: GPL-2.0+ |
| * Discription: Provides cpu speed calculation |
| #include <asm/processor.h> |
| volatile immap_t *immr = (immap_t *) CONFIG_SYS_IMMR; |
| #ifndef CONFIG_5xx_GCLK_FREQ |
| uint divf = (immr->im_clkrst.car_plprcr & PLPRCR_DIVF_MSK); |
| uint mf = ((immr->im_clkrst.car_plprcr & PLPRCR_MF_MSK) >> PLPRCR_MF_SHIFT); |
| vcoout = (CONFIG_SYS_OSC_CLK / (divf + 1)) * (mf + 1) * 2; |
| if(immr->im_clkrst.car_plprcr & PLPRCR_CSRC_MSK) { |
| gd->cpu_clk = vcoout / (2^(((immr->im_clkrst.car_sccr & SCCR_DFNL_MSK) >> SCCR_DFNL_SHIFT) + 1)); |
| gd->cpu_clk = vcoout / (2^(immr->im_clkrst.car_sccr & SCCR_DFNH_MSK)); |
| #else /* CONFIG_5xx_GCLK_FREQ */ |
| gd->bus_clk = CONFIG_5xx_GCLK_FREQ; |
| #endif /* CONFIG_5xx_GCLK_FREQ */ |
| if ((immr->im_clkrst.car_sccr & SCCR_EBDF11) == 0) { |
| /* No Bus Divider active */ |
| gd->bus_clk = gd->cpu_clk; |
| gd->bus_clk = gd->cpu_clk / 2; |