mirror of
https://github.com/AsahiLinux/u-boot
synced 2024-11-26 06:30:39 +00:00
2dd97488ee
Fix the compiler warning u8500_href.c: In function 'hrefplus_mmc_power_init': u8500_href.c:258: warning: implicit declaration of function 'prcmu_i2c_read' u8500_href.c:265: warning: implicit declaration of function 'prcmu_i2c_write' by adding the missing header file. Signed-off-by: Dirk Behme <dirk.behme@googlemail.com>
547 lines
16 KiB
C
547 lines
16 KiB
C
/*
|
|
* 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 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 /* 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",
|
|
""
|
|
);
|