| /* |
| * Copyright (C) ST-Ericsson SA 2009 |
| * |
| * 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., 675 Mass Ave, Cambridge, MA 02139, USA. |
| */ |
| |
| #include <config.h> |
| #include <common.h> |
| #include <i2c.h> |
| #include <asm/types.h> |
| #include <asm/io.h> |
| #include <asm/errno.h> |
| #include <asm/arch/clock.h> |
| #include <asm/arch/gpio.h> |
| #include <asm/arch/hardware.h> |
| #include <asm/arch/sys_proto.h> |
| #ifdef CONFIG_MMC |
| #include "prcmu-fw.h" |
| #include "../../../drivers/mmc/arm_pl180_mmci.h" |
| #endif |
| |
| #define NOMADIK_PER4_BASE (0x80150000) |
| #define NOMADIK_BACKUPRAM0_BASE (NOMADIK_PER4_BASE + 0x00000) |
| #define NOMADIK_BACKUPRAM1_BASE (NOMADIK_PER4_BASE + 0x01000) |
| |
| /* Power, Reset, Clock Management Unit */ |
| /* |
| * SVA: Smart Video Accelerator |
| * SIA: Smart Imaging Accelerator |
| * SGA: Smart Graphic accelerator |
| * B2R2: Graphic blitter |
| */ |
| #define PRCMU_BASE CFG_PRCMU_BASE /* 0x80157000 for U8500 */ |
| #define PRCM_ARMCLKFIX_MGT_REG (PRCMU_BASE + 0x000) |
| #define PRCM_ACLK_MGT_REG (PRCMU_BASE + 0x004) |
| #define PRCM_SVAMMDSPCLK_MGT_REG (PRCMU_BASE + 0x008) |
| #define PRCM_SIAMMDSPCLK_MGT_REG (PRCMU_BASE + 0x00C) |
| #define PRCM_SAAMMDSPCLK_MGT_REG (PRCMU_BASE + 0x010) |
| #define PRCM_SGACLK_MGT_REG (PRCMU_BASE + 0x014) |
| #define PRCM_UARTCLK_MGT_REG (PRCMU_BASE + 0x018) |
| #define PRCM_MSPCLK_MGT_REG (PRCMU_BASE + 0x01C) |
| #define PRCM_I2CCLK_MGT_REG (PRCMU_BASE + 0x020) |
| #define PRCM_SDMMCCLK_MGT_REG (PRCMU_BASE + 0x024) |
| #define PRCM_SLIMCLK_MGT_REG (PRCMU_BASE + 0x028) |
| #define PRCM_PER1CLK_MGT_REG (PRCMU_BASE + 0x02C) |
| #define PRCM_PER2CLK_MGT_REG (PRCMU_BASE + 0x030) |
| #define PRCM_PER3CLK_MGT_REG (PRCMU_BASE + 0x034) |
| #define PRCM_PER5CLK_MGT_REG (PRCMU_BASE + 0x038) |
| #define PRCM_PER6CLK_MGT_REG (PRCMU_BASE + 0x03C) |
| #define PRCM_PER7CLK_MGT_REG (PRCMU_BASE + 0x040) |
| #define PRCM_DMACLK_MGT_REG (PRCMU_BASE + 0x074) |
| #define PRCM_B2R2CLK_MGT_REG (PRCMU_BASE + 0x078) |
| |
| #define PRCM_PLLSOC0_FREQ_REG (PRCMU_BASE + 0x080) |
| #define PRCM_PLLSOC1_FREQ_REG (PRCMU_BASE + 0x084) |
| #define PRCM_PLLARM_FREQ_REG (PRCMU_BASE + 0x088) |
| #define PRCM_PLLDDR_FREQ_REG (PRCMU_BASE + 0x08C) |
| #define PRCM_ARM_CHGCLKREQ_REG (PRCMU_BASE + 0x114) |
| |
| #define PRCM_TCR (PRCMU_BASE + 0x1C8) |
| |
| /* |
| * Memory controller register |
| */ |
| #define DMC_BASE_ADDR 0x80156000 |
| #define DMC_CTL_97 (DMC_BASE_ADDR + 0x184) |
| |
| int board_id; /* set in board_late_init() */ |
| |
| /* PLLs for clock management registers */ |
| enum { |
| GATED = 0, |
| PLLSOC0, /* pllsw = 001, ffs() = 1 */ |
| PLLSOC1, /* pllsw = 010, ffs() = 2 */ |
| PLLDDR, /* pllsw = 100, ffs() = 3 */ |
| PLLARM, |
| }; |
| |
| static struct pll_freq_regs { |
| int idx; /* index fror pll_name and pll_khz arrays */ |
| uint32_t addr; |
| } pll_freq_regs[] = { |
| {PLLSOC0, PRCM_PLLSOC0_FREQ_REG}, |
| {PLLSOC1, PRCM_PLLSOC1_FREQ_REG}, |
| {PLLDDR, PRCM_PLLDDR_FREQ_REG}, |
| {PLLARM, PRCM_PLLARM_FREQ_REG}, |
| {0, 0}, |
| }; |
| |
| static const char *pll_name[5] = {"GATED", "SOC0", "SOC1", "DDR", "ARM"}; |
| static uint32_t pll_khz[5]; /* use ffs(pllsw(reg)) as index for 0..3 */ |
| |
| static struct clk_mgt_regs { |
| uint32_t addr; |
| uint32_t val; |
| const char *descr; |
| } clk_mgt_regs[] = { |
| /* register content taken from bootrom settings */ |
| {PRCM_ARMCLKFIX_MGT_REG, 0x0120, "ARMCLKFIX"}, /* ena, SOC0/0, ??? */ |
| {PRCM_ACLK_MGT_REG, 0x0125, "ACLK"}, /* ena, SOC0/5, 160 MHz */ |
| {PRCM_SVAMMDSPCLK_MGT_REG, 0x1122, "SVA"}, /* ena, SOC0/2, 400 MHz */ |
| {PRCM_SIAMMDSPCLK_MGT_REG, 0x0022, "SIA"}, /* dis, SOC0/2, 400 MHz */ |
| {PRCM_SAAMMDSPCLK_MGT_REG, 0x0822, "SAA"}, /* dis, SOC0/4, 200 MHz */ |
| {PRCM_SGACLK_MGT_REG, 0x0024, "SGA"}, /* dis, SOC0/4, 200 MHz */ |
| {PRCM_UARTCLK_MGT_REG, 0x0300, "UART"}, /* ena, GATED, CLK38 */ |
| {PRCM_MSPCLK_MGT_REG, 0x0200, "MSP"}, /* dis, GATED, CLK38 */ |
| {PRCM_I2CCLK_MGT_REG, 0x0130, "I2C"}, /* ena, SOC0/16, 50 MHz */ |
| {PRCM_SDMMCCLK_MGT_REG, 0x0130, "SDMMC"}, /* ena, SOC0/16, 50 MHz */ |
| {PRCM_PER1CLK_MGT_REG, 0x126, "PER1"}, /* ena, SOC0/6, 133 MHz */ |
| {PRCM_PER2CLK_MGT_REG, 0x126, "PER2"}, /* ena, SOC0/6, 133 MHz */ |
| {PRCM_PER3CLK_MGT_REG, 0x126, "PER3"}, /* ena, SOC0/6, 133 MHz */ |
| {PRCM_PER5CLK_MGT_REG, 0x126, "PER5"}, /* ena, SOC0/6, 133 MHz */ |
| {PRCM_PER6CLK_MGT_REG, 0x126, "PER6"}, /* ena, SOC0/6, 133 MHz */ |
| {PRCM_PER7CLK_MGT_REG, 0x128, "PER7"}, /* ena, SOC0/8, 100 MHz */ |
| {PRCM_DMACLK_MGT_REG, 0x125, "DMA"}, /* ena, SOC0/5, 160 MHz */ |
| {PRCM_B2R2CLK_MGT_REG, 0x025, "B2R2"}, /* dis, SOC0/5, 160 MHz */ |
| {0, 0, NULL}, |
| }; |
| |
| static void init_regs(void); |
| |
| DECLARE_GLOBAL_DATA_PTR; |
| #if defined(CONFIG_SHOW_BOOT_PROGRESS) |
| void show_boot_progress(int progress) |
| { |
| printf("Boot reached stage %d\n", progress); |
| } |
| #endif |
| |
| static unsigned int read_asicid(void) |
| { |
| unsigned int *address = (void *)U8500_BOOTROM_BASE |
| + U8500_BOOTROM_ASIC_ID_OFFSET; |
| return readl(address); |
| } |
| |
| int cpu_is_u8500v11(void) |
| { |
| return read_asicid() == 0x008500A1; |
| } |
| |
| /* |
| * Miscellaneous platform dependent initialisations |
| */ |
| |
| int board_early_init_f(void) |
| { |
| init_regs(); |
| return 0; |
| } |
| |
| int board_init(void) |
| { |
| uint32_t unused_cols_rows; |
| unsigned int nrows; |
| unsigned int ncols; |
| |
| gd->bd->bi_arch_number = 0x1A4; |
| gd->bd->bi_boot_params = 0x00000100; |
| gd->bd->bi_dram[0].start = CONFIG_SYS_SDRAM_BASE; |
| |
| /* |
| * Assumption: 2 CS active, both CS have same layout. |
| * 15 rows max, 11 cols max (controller spec). |
| * memory chip has 8 banks, I/O width 32 bit. |
| * The correct way would be to read MR#8: I/O width and density, |
| * but this requires locking against the PRCMU firmware. |
| * Simplified approach: |
| * Read number of unused rows and columns from mem controller. |
| * size = nCS x 2^(rows+cols) x nbanks x buswidth_bytes |
| */ |
| unused_cols_rows = readl(DMC_CTL_97); |
| nrows = 15 - (unused_cols_rows & 0x07); |
| ncols = 11 - ((unused_cols_rows & 0x0700) >> 8); |
| gd->bd->bi_dram[0].size = 2 * (1 << (nrows + ncols)) * 8 * 4; |
| |
| icache_enable(); |
| |
| return 0; |
| } |
| |
| int dram_init(void) |
| { |
| gd->ram_size = PHYS_SDRAM_SIZE_1; |
| |
| return 0; |
| } |
| |
| unsigned int addr_vall_arr[] = { |
| 0x8011F000, 0x0000FFFF, /* Clocks for HSI TODO: Enable reqd only */ |
| 0x8011F008, 0x00001CFF, /* Clocks for HSI TODO: Enable reqd only */ |
| 0x8000F000, 0x00007FFF, /* Clocks for I2C TODO: Enable reqd only */ |
| 0x8000F008, 0x00007FFF, /* Clocks for I2C TODO: Enable reqd only */ |
| 0x80157020, 0x00000150, /* I2C 48MHz clock */ |
| 0x8012F000, 0x00007FFF, /* Clocks for SD TODO: Enable reqd only */ |
| 0x8012F008, 0x00007FFF, /* Clocks for SD TODO: Enable reqd only */ |
| 0xA03DF000, 0x0000000D, /* Clock for MTU Timers */ |
| 0x8011E00C, 0x00000000, /* GPIO ALT FUNC for EMMC */ |
| 0x8011E004, 0x0000FFE0, /* GPIO ALT FUNC for EMMC */ |
| 0x8011E020, 0x0000FFE0, /* GPIO ALT FUNC for EMMC */ |
| 0x8011E024, 0x00000000, /* GPIO ALT FUNC for EMMC */ |
| 0x8012E000, 0x20000000, /* GPIO ALT FUNC for UART */ |
| 0x8012E00C, 0x00000000, /* GPIO ALT FUNC for SD */ |
| 0x8012E004, 0x0FFC0000, /* GPIO ALT FUNC for SD */ |
| 0x8012E020, 0x60000000, /* GPIO ALT FUNC for SD */ |
| 0x8012E024, 0x60000000, /* GPIO ALT FUNC for SD */ |
| 0x801571E4, 0x0000000C, /* PRCMU settings for B2R2, |
| PRCM_APE_RESETN_SET_REG */ |
| 0x80157024, 0x00000130, /* PRCMU settings for EMMC/SD */ |
| 0xA03FF000, 0x00000003, /* USB */ |
| 0xA03FF008, 0x00000001, /* USB */ |
| 0xA03FE00C, 0x00000000, /* USB */ |
| 0xA03FE020, 0x00000FFF, /* USB */ |
| 0xA03FE024, 0x00000000 /* USB */ |
| }; |
| |
| #ifdef CONFIG_BOARD_LATE_INIT |
| #ifdef CONFIG_MMC |
| |
| #define LDO_VAUX3_MASK 0x3 |
| #define LDO_VAUX3_ENABLE 0x1 |
| #define VAUX3_VOLTAGE_2_9V 0xd |
| |
| #define AB8500_REGU_CTRL2 0x4 |
| #define AB8500_REGU_VRF1VAUX3_REGU_REG 0x040A |
| #define AB8500_REGU_VRF1VAUX3_SEL_REG 0x0421 |
| |
| static int hrefplus_mmc_power_init(void) |
| { |
| int ret; |
| int val; |
| |
| if (!cpu_is_u8500v11()) |
| return 0; |
| |
| /* |
| * On v1.1 HREF boards (HREF+), Vaux3 needs to be enabled for the SD |
| * card to work. This is done by enabling the regulators in the AB8500 |
| * via PRCMU I2C transactions. |
| * |
| * This code is derived from the handling of AB8500_LDO_VAUX3 in |
| * ab8500_ldo_enable() and ab8500_ldo_disable() in Linux. |
| * |
| * Turn off and delay is required to have it work across soft reboots. |
| */ |
| |
| ret = prcmu_i2c_read(AB8500_REGU_CTRL2, AB8500_REGU_VRF1VAUX3_REGU_REG); |
| if (ret < 0) |
| goto out; |
| |
| val = ret; |
| |
| /* Turn off */ |
| ret = prcmu_i2c_write(AB8500_REGU_CTRL2, AB8500_REGU_VRF1VAUX3_REGU_REG, |
| val & ~LDO_VAUX3_MASK); |
| if (ret < 0) |
| goto out; |
| |
| udelay(10 * 1000); |
| |
| /* Set the voltage to 2.9V */ |
| ret = prcmu_i2c_write(AB8500_REGU_CTRL2, |
| AB8500_REGU_VRF1VAUX3_SEL_REG, |
| VAUX3_VOLTAGE_2_9V); |
| if (ret < 0) |
| goto out; |
| |
| val = val & ~LDO_VAUX3_MASK; |
| val = val | LDO_VAUX3_ENABLE; |
| |
| /* Turn on the supply */ |
| ret = prcmu_i2c_write(AB8500_REGU_CTRL2, |
| AB8500_REGU_VRF1VAUX3_REGU_REG, val); |
| |
| out: |
| return ret; |
| } |
| #endif |
| /* |
| * called after all initialisation were done, but before the generic |
| * mmc_initialize(). |
| */ |
| int board_late_init(void) |
| { |
| uchar byte; |
| |
| /* |
| * Determine and set board_id environment variable |
| * 0: mop500, 1: href500 |
| * Above boards have different GPIO expander chips which we can |
| * distinguish by the chip id. |
| * |
| * The board_id environment variable is needed for the Linux bootargs. |
| */ |
| (void) i2c_set_bus_num(0); |
| (void) i2c_read(CONFIG_SYS_I2C_GPIOE_ADDR, 0x80, 1, &byte, 1); |
| if (byte == 0x01) { |
| board_id = 0; |
| setenv("board_id", "0"); |
| } else { |
| board_id = 1; |
| setenv("board_id", "1"); |
| } |
| #ifdef CONFIG_MMC |
| hrefplus_mmc_power_init(); |
| |
| /* |
| * config extended GPIO pins for level shifter and |
| * SDMMC_ENABLE |
| */ |
| if (board_id == 0) { |
| /* MOP500 */ |
| byte = 0x0c; |
| (void) i2c_write(CONFIG_SYS_I2C_GPIOE_ADDR, 0x89, 1, &byte, 1); |
| (void) i2c_write(CONFIG_SYS_I2C_GPIOE_ADDR, 0x83, 1, &byte, 1); |
| } else { |
| /* HREF */ |
| /* set the direction of GPIO KPY9 and KPY10 */ |
| byte = 0x06; |
| (void) i2c_write(CONFIG_SYS_I2C_GPIOE_ADDR, 0xC8, 1, &byte, 1); |
| /* must be a multibyte access */ |
| (void) i2c_write(CONFIG_SYS_I2C_GPIOE_ADDR, 0xC4, 1, |
| (uchar []) {0x06, 0x06}, 2); |
| } |
| #endif /* CONFIG_MMC */ |
| /* |
| * Create a memargs variable which points uses either the memargs256 or |
| * memargs512 environment variable, depending on the memory size. |
| * memargs is used to build the bootargs, memargs256 and memargs512 are |
| * stored in the environment. |
| */ |
| if (gd->bd->bi_dram[0].size == 0x10000000) { |
| setenv("memargs", "setenv bootargs ${bootargs} ${memargs256}"); |
| setenv("mem", "256M"); |
| } else { |
| setenv("memargs", "setenv bootargs ${bootargs} ${memargs512}"); |
| setenv("mem", "512M"); |
| } |
| |
| return 0; |
| } |
| #endif /* CONFIG_BOARD_LATE_INIT */ |
| |
| static void early_gpio_setup(struct gpio_register *gpio_reg, u32 bits) |
| { |
| writel(readl(&gpio_reg->gpio_dats) | bits, &gpio_reg->gpio_dats); |
| writel(readl(&gpio_reg->gpio_pdis) & ~bits, &gpio_reg->gpio_pdis); |
| } |
| |
| static void init_regs(void) |
| { |
| /* FIXME Remove magic register array settings for ED also */ |
| struct prcmu *prcmu = (struct prcmu *) U8500_PRCMU_BASE; |
| |
| /* Enable timers */ |
| writel(1 << 17, &prcmu->tcr); |
| |
| u8500_prcmu_enable(&prcmu->per1clk_mgt); |
| u8500_prcmu_enable(&prcmu->per2clk_mgt); |
| u8500_prcmu_enable(&prcmu->per3clk_mgt); |
| u8500_prcmu_enable(&prcmu->per5clk_mgt); |
| u8500_prcmu_enable(&prcmu->per6clk_mgt); |
| u8500_prcmu_enable(&prcmu->per7clk_mgt); |
| |
| u8500_prcmu_enable(&prcmu->uartclk_mgt); |
| u8500_prcmu_enable(&prcmu->i2cclk_mgt); |
| |
| u8500_prcmu_enable(&prcmu->sdmmcclk_mgt); |
| |
| u8500_clock_enable(1, 9, -1); /* GPIO0 */ |
| |
| u8500_clock_enable(2, 11, -1); /* GPIO1 */ |
| |
| u8500_clock_enable(3, 8, -1); /* GPIO2 */ |
| u8500_clock_enable(5, 1, -1); /* GPIO3 */ |
| |
| u8500_clock_enable(3, 6, 6); /* UART2 */ |
| |
| gpio_altfuncenable(GPIO_ALT_I2C_0, "I2C0"); |
| u8500_clock_enable(3, 3, 3); /* I2C0 */ |
| |
| early_gpio_setup((struct gpio_register *)U8500_GPIO_0_BASE, 0x60000000); |
| gpio_altfuncenable(GPIO_ALT_UART_2, "UART2"); |
| |
| early_gpio_setup((struct gpio_register *)U8500_GPIO_6_BASE, 0x0000ffe0); |
| gpio_altfuncenable(GPIO_ALT_EMMC, "EMMC"); |
| |
| early_gpio_setup((struct gpio_register *)U8500_GPIO_0_BASE, 0x0000ffe0); |
| gpio_altfuncenable(GPIO_ALT_SD_CARD0, "SDCARD"); |
| |
| u8500_clock_enable(1, 5, 5); /* SDI0 */ |
| u8500_clock_enable(2, 4, 2); /* SDI4 */ |
| |
| u8500_clock_enable(6, 7, -1); /* MTU0 */ |
| u8500_clock_enable(3, 4, 4); /* SDI2 */ |
| |
| early_gpio_setup((struct gpio_register *)U8500_GPIO_4_BASE, 0x000007ff); |
| gpio_altfuncenable(GPIO_ALT_POP_EMMC, "EMMC"); |
| |
| /* |
| * Enabling clocks for all devices which are AMBA devices in the |
| * kernel. Otherwise they will not get probe()'d because the |
| * peripheral ID register will not be powered. |
| */ |
| |
| /* XXX: some of these differ between ED/V1 */ |
| |
| u8500_clock_enable(1, 1, 1); /* UART1 */ |
| u8500_clock_enable(1, 0, 0); /* UART0 */ |
| |
| u8500_clock_enable(3, 2, 2); /* SSP1 */ |
| u8500_clock_enable(3, 1, 1); /* SSP0 */ |
| |
| u8500_clock_enable(2, 8, -1); /* SPI0 */ |
| u8500_clock_enable(2, 5, 3); /* MSP2 */ |
| } |
| |
| #ifdef CONFIG_MMC |
| static int u8500_mmci_board_init(void) |
| { |
| enum gpio_error error; |
| struct gpio_register *gpio_base_address; |
| |
| gpio_base_address = (void *)(U8500_GPIO_0_BASE); |
| gpio_base_address->gpio_dats |= 0xFFC0000; |
| gpio_base_address->gpio_pdis &= ~0xFFC0000; |
| |
| /* save the GPIO0 AFSELA register */ |
| error = gpio_altfuncenable(GPIO_ALT_SD_CARD0, "MMC"); |
| if (error != GPIO_OK) { |
| printf("u8500_mmci_board_init() gpio_altfuncenable failed\n"); |
| return -ENODEV; |
| } |
| return 0; |
| } |
| |
| int board_mmc_init(bd_t *bd) |
| { |
| if (u8500_mmci_board_init()) |
| return -ENODEV; |
| |
| if (arm_pl180_mmci_init()) |
| return -ENODEV; |
| return 0; |
| } |
| #endif |
| |
| |
| /* |
| * get_pll_freq_khz - return PLL frequency in kHz |
| */ |
| static uint32_t get_pll_freq_khz(uint32_t inclk_khz, uint32_t freq_reg) |
| { |
| uint32_t idf, ldf, odf, seldiv, phi; |
| |
| /* |
| * PLLOUTCLK = PHI = (INCLK*LDF)/(2*ODF*IDF) if SELDIV2=0 |
| * PLLOUTCLK = PHI = (INCLK*LDF)/(4*ODF*IDF) if SELDIV2=1 |
| * where: |
| * IDF=R(2:0) (when R=000, IDF=1d) |
| * LDF = 2*D(7:0) (D must be greater than or equal to 6) |
| * ODF = N(5:0) (when N=000000, 0DF=1d) |
| */ |
| |
| idf = (freq_reg & 0x70000) >> 16; |
| ldf = (freq_reg & 0xff) * 2; |
| odf = (freq_reg & 0x3f00) >> 8; |
| seldiv = (freq_reg & 0x01000000) >> 24; |
| phi = (inclk_khz * ldf) / (2 * odf * idf); |
| if (seldiv) |
| phi = phi/2; |
| |
| return phi; |
| } |
| |
| int do_clkinfo(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) |
| { |
| uint32_t inclk_khz; |
| uint32_t reg, phi; |
| uint32_t clk_khz; |
| unsigned int clk_sel; |
| struct clk_mgt_regs *clks = clk_mgt_regs; |
| struct pll_freq_regs *plls = pll_freq_regs; |
| |
| /* |
| * Go through list of PLLs. |
| * Initialise pll out frequency array (pll_khz) and print frequency. |
| */ |
| inclk_khz = 38400; /* 38.4 MHz */ |
| while (plls->addr) { |
| reg = readl(plls->addr); |
| phi = get_pll_freq_khz(inclk_khz, reg); |
| pll_khz[plls->idx] = phi; |
| printf("%s PLL out frequency: %d.%d Mhz\n", |
| pll_name[plls->idx], phi/1000, phi % 1000); |
| plls++; |
| } |
| |
| /* check ARM clock source */ |
| reg = readl(PRCM_ARM_CHGCLKREQ_REG); |
| printf("A9 running on %s\n", |
| (reg & 1) ? "external clock" : "ARM PLL"); |
| |
| /* go through list of clk_mgt_reg */ |
| printf("\n%19s %9s %7s %9s enabled\n", |
| "name(addr)", "value", "PLL", "CLK[MHz]"); |
| while (clks->addr) { |
| reg = readl(clks->addr); |
| |
| /* convert bit position into array index */ |
| clk_sel = ffs((reg >> 5) & 0x7); /* PLLSW[2:0] */ |
| |
| if (reg & 0x200) |
| clk_khz = 38400; /* CLK38 is set */ |
| else if ((reg & 0x1f) == 0) |
| /* ARMCLKFIX_MGT is 0x120, e.g. div = 0 ! */ |
| clk_khz = 0; |
| else |
| clk_khz = pll_khz[clk_sel] / (reg & 0x1f); |
| |
| printf("%9s(%08x): %08x, %6s, %4d.%03d, %s\n", |
| clks->descr, clks->addr, reg, pll_name[clk_sel], |
| clk_khz / 1000, clk_khz % 1000, |
| (reg & 0x100) ? "ena" : "dis"); |
| clks++; |
| } |
| |
| return 0; |
| } |
| |
| U_BOOT_CMD( |
| clkinfo, 1, 1, do_clkinfo, |
| "print clock info", |
| "" |
| ); |