This imports the low level init code from at91bootstrap https://github.com/linux4sam/at91bootstrap/blob/v3.8.12/board/sama5d3_xplained/sama5d3_xplained.c
Signed-off-by: Ahmad Fatoum <[email protected]> --- .../boards/microchip-ksz9477-evb/lowlevel.c | 208 +++++++++++++++++- arch/arm/mach-at91/Kconfig | 2 + arch/arm/mach-at91/include/mach/at91_pmc.h | 8 + arch/arm/mach-at91/include/mach/sama5d3.h | 1 + images/Makefile.at91 | 5 + 5 files changed, 220 insertions(+), 4 deletions(-) diff --git a/arch/arm/boards/microchip-ksz9477-evb/lowlevel.c b/arch/arm/boards/microchip-ksz9477-evb/lowlevel.c index 4293f8aaa57d..cf44021bdfb7 100644 --- a/arch/arm/boards/microchip-ksz9477-evb/lowlevel.c +++ b/arch/arm/boards/microchip-ksz9477-evb/lowlevel.c @@ -1,7 +1,19 @@ +// SPDX-License-Identifier: GPL-2.0-only AND BSD-1-Clause /* + * Copyright (c) 2014, Atmel Corporation * Copyright (C) 2018 Ahmad Fatoum, Pengutronix * - * Under GPLv2 + * + * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR + * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF + * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE + * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT, + * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT + * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, + * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF + * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING + * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, + * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. */ #include <common.h> @@ -10,18 +22,206 @@ #include <asm/barebox-arm-head.h> #include <asm/barebox-arm.h> -#include <mach/hardware.h> +#include <debug_ll.h> +#include <linux/kconfig.h> +#include <mach/at91_dbgu.h> +#include <mach/at91_ddrsdrc.h> +#include <mach/at91_pmc_ll.h> +#include <mach/at91_pio.h> +#include <mach/at91_wdt.h> +#include <mach/ddramc.h> +#include <mach/early_udelay.h> +#include <mach/gpio.h> +#include <mach/iomux.h> + +/* PCK = 528MHz, MCK = 132MHz */ +#define MASTER_CLOCK 132000000 + +#define PMC_BASE IOMEM(SAMA5D3_BASE_PMC) +#define sama5d3_pmc_enable_periph_clock(clk) \ + at91_pmc_enable_periph_clock(PMC_BASE, clk) + +#define BAUDRATE(mck, baud) \ + ((((((mck) * 10) / ((baud) * 16)) % 10) >= 5) ? \ + (mck / (baud * 16) + 1) : ((mck) / (baud * 16))) + + +static void configure_periph_a_piob_pin(unsigned int pin) +{ + void __iomem *pio = IOMEM(SAMA5D3_BASE_PIOB); + u32 mask = pin_to_mask(pin); + + at91_mux_disable_interrupt(pio, mask); + at91_mux_set_pullup(pio, mask, 0); + at91_mux_pio3_set_pulldown(pio, mask, 0); + + at91_mux_pio3_set_A_periph(pio, mask); + + at91_mux_gpio_disable(pio, mask); +} + +static noinline void dbgu_init(void) +{ + sama5d3_pmc_enable_periph_clock(SAMA5D3_ID_PIOB); + + configure_periph_a_piob_pin(AT91_PIN_PB30); + configure_periph_a_piob_pin(AT91_PIN_PB31); + + sama5d3_pmc_enable_periph_clock(SAMA5D3_ID_DBGU); + at91_dbgu_setup_ll(AT91_BASE_DBGU1, BAUDRATE(MASTER_CLOCK, 115200)); + + putc_ll('>'); +} + +static void ddramc_reg_config(struct at91_ddramc_register *ddramc_config) +{ + ddramc_config->mdr = (AT91C_DDRC2_DBW_32_BITS + | AT91C_DDRC2_MD_DDR2_SDRAM); + + ddramc_config->cr = (AT91C_DDRC2_NC_DDR10_SDR9 + | AT91C_DDRC2_NR_13 + | AT91C_DDRC2_CAS_3 + | AT91C_DDRC2_DISABLE_RESET_DLL + | AT91C_DDRC2_ENABLE_DLL + | AT91C_DDRC2_ENRDM_ENABLE + | AT91C_DDRC2_NB_BANKS_8 + | AT91C_DDRC2_NDQS_DISABLED + | AT91C_DDRC2_DECOD_INTERLEAVED + | AT91C_DDRC2_UNAL_SUPPORTED); + + /* + * The DDR2-SDRAM device requires a refresh every 15.625 us or 7.81 us. + * With a 133 MHz frequency, the refresh timer count register must to be + * set with (15.625 x 133 MHz) ~ 2084 i.e. 0x824 + * or (7.81 x 133 MHz) ~ 1039 i.e. 0x40F. + */ + ddramc_config->rtr = 0x40F; /* Refresh timer: 7.812us */ + + /* One clock cycle @ 133 MHz = 7.5 ns */ + ddramc_config->t0pr = (AT91C_DDRC2_TRAS_(6) /* 6 * 7.5 = 45 ns */ + | AT91C_DDRC2_TRCD_(2) /* 2 * 7.5 = 22.5 ns */ + | AT91C_DDRC2_TWR_(2) /* 2 * 7.5 = 15 ns */ + | AT91C_DDRC2_TRC_(8) /* 8 * 7.5 = 75 ns */ + | AT91C_DDRC2_TRP_(2) /* 2 * 7.5 = 15 ns */ + | AT91C_DDRC2_TRRD_(2) /* 2 * 7.5 = 15 ns */ + | AT91C_DDRC2_TWTR_(2) /* 2 clock cycles min */ + | AT91C_DDRC2_TMRD_(2)); /* 2 clock cycles */ + + ddramc_config->t1pr = (AT91C_DDRC2_TXP_(2) /* 2 clock cycles */ + | AT91C_DDRC2_TXSRD_(200) /* 200 clock cycles */ + | AT91C_DDRC2_TXSNR_(19) /* 19 * 7.5 = 142.5 ns */ + | AT91C_DDRC2_TRFC_(17)); /* 17 * 7.5 = 127.5 ns */ + + ddramc_config->t2pr = (AT91C_DDRC2_TFAW_(6) /* 6 * 7.5 = 45 ns */ + | AT91C_DDRC2_TRTP_(2) /* 2 clock cycles min */ + | AT91C_DDRC2_TRPA_(2) /* 2 * 7.5 = 15 ns */ + | AT91C_DDRC2_TXARDS_(8) /* = TXARD */ + | AT91C_DDRC2_TXARD_(8)); /* MR12 = 1 */ +} + +static void sama5d3_ddramc_init(void) +{ + struct at91_ddramc_register ddramc_reg; + u32 reg; + + ddramc_reg_config(&ddramc_reg); + + /* enable ddr2 clock */ + sama5d3_pmc_enable_periph_clock(SAMA5D3_ID_MPDDRC); + at91_pmc_enable_system_clock(PMC_BASE, AT91CAP9_PMC_DDR); + + + /* Init the special register for sama5d3x */ + /* MPDDRC DLL Slave Offset Register: DDR2 configuration */ + reg = AT91C_MPDDRC_S0OFF_1 + | AT91C_MPDDRC_S2OFF_1 + | AT91C_MPDDRC_S3OFF_1; + writel(reg, SAMA5D3_BASE_MPDDRC + AT91C_MPDDRC_DLL_SOR); + /* MPDDRC DLL Master Offset Register */ + /* write master + clk90 offset */ + reg = AT91C_MPDDRC_MOFF_7 + | AT91C_MPDDRC_CLK90OFF_31 + | AT91C_MPDDRC_SELOFF_ENABLED | AT91C_MPDDRC_KEY; + writel(reg, SAMA5D3_BASE_MPDDRC + AT91C_MPDDRC_DLL_MOR); + + /* MPDDRC I/O Calibration Register */ + /* DDR2 RZQ = 50 Ohm */ + /* TZQIO = 4 */ + reg = AT91C_MPDDRC_RDIV_DDR2_RZQ_50 + | AT91C_MPDDRC_TZQIO_4; + writel(reg, SAMA5D3_BASE_MPDDRC + AT91C_MPDDRC_IO_CALIBR); + + /* DDRAM2 Controller initialize */ + at91_ddram_initialize(SAMA5D3_BASE_MPDDRC, SAMA5_DDRCS, &ddramc_reg); +} + +extern char __dtb_z_at91_microchip_ksz9477_evb_boot_bin_start[]; extern char __dtb_z_at91_microchip_ksz9477_evb_start[]; -ENTRY_FUNCTION(start_sama5d3_xplained_ung8071, r0, r1, r2) +static noinline void board_init(void) { - void *fdt; + void *fdt = NULL; + + at91_wdt_disable(IOMEM(SAMA5D3_BASE_WDT)); + at91_pmc_init(PMC_BASE, AT91_PMC_LL_SAMA5D3); + + /* At this stage the main oscillator + * is supposed to be enabled PCK = MCK = MOSC + */ + + /* Configure PLLA = MOSC * (PLL_MULA + 1) / PLL_DIVA */ + at91_pmc_cfg_plla(PMC_BASE, AT91_PMC3_MUL_(43) | AT91_PMC_OUT_0 + | AT91_PMC_PLLCOUNT + | AT91_PMC_DIV_BYPASS, + AT91_PMC_LL_SAMA5D3); + + /* Initialize PLLA charge pump */ + at91_pmc_init_pll(PMC_BASE, AT91_PMC_IPLLA_3); + + /* Switch PCK/MCK on Main clock output */ + at91_pmc_cfg_mck(PMC_BASE, AT91SAM9_PMC_MDIV_4 | AT91_PMC_CSS_MAIN, + AT91_PMC_LL_SAMA5D3); + + /* Switch PCK/MCK on PLLA output */ + at91_pmc_cfg_mck(PMC_BASE, AT91SAM9_PMC_MDIV_4 | AT91_PMC_CSS_PLLA, + AT91_PMC_LL_SAMA5D3); + + if (IS_ENABLED(CONFIG_DEBUG_LL)) + dbgu_init(); + + early_udelay_init(PMC_BASE, IOMEM(SAMA5D3_BASE_PIT), + SAMA5D3_ID_PIT, MASTER_CLOCK, AT91_PMC_LL_SAMA5D3); + + sama5d3_ddramc_init(); + fdt = __dtb_z_at91_microchip_ksz9477_evb_boot_bin_start + get_runtime_offset(); + + barebox_arm_entry(SAMA5_DDRCS, SZ_256M, fdt); +} + +ENTRY_FUNCTION(start_sama5d3_xplained_ung8071_boot_bin, r0, r1, r2) +{ arm_cpu_lowlevel_init(); arm_setup_stack(SAMA5D3_SRAM_BASE + SAMA5D3_SRAM_SIZE - 16); + relocate_to_current_adr(); + setup_c(); + barrier(); + + board_init(); +} + +ENTRY_FUNCTION(start_sama5d3_xplained_ung8071, r0, r1, r2) +{ + void *fdt; + + arm_setup_stack(SAMA5D3_SRAM_BASE + SAMA5D3_SRAM_SIZE - 16); + + if (IS_ENABLED(CONFIG_DEBUG_LL)) + dbgu_init(); + fdt = __dtb_z_at91_microchip_ksz9477_evb_start + get_runtime_offset(); barebox_arm_entry(SAMA5_DDRCS, SZ_256M, fdt); diff --git a/arch/arm/mach-at91/Kconfig b/arch/arm/mach-at91/Kconfig index 1401b8cfc9bb..e72e37c2bf9e 100644 --- a/arch/arm/mach-at91/Kconfig +++ b/arch/arm/mach-at91/Kconfig @@ -200,6 +200,7 @@ config ARCH_SAMA5D3 select SOC_SAMA5D3 select HAS_MACB select HAVE_MACH_ARM_HEAD + select HAVE_AT91_LOAD_BAREBOX_SRAM config ARCH_SAMA5D4 bool "SAMA5D4" @@ -548,6 +549,7 @@ config MACH_MICROCHIP_KSZ9477_EVB select OFDEVICE select COMMON_CLK_OF_PROVIDER select ARM_USE_COMPRESSED_DTB + select HAVE_AT91_BOOTSTRAP help Select this if you are using Microchip's EVB-KSZ9477 Evaluation Kit. diff --git a/arch/arm/mach-at91/include/mach/at91_pmc.h b/arch/arm/mach-at91/include/mach/at91_pmc.h index 4d60becefbab..dfc0fa63017f 100644 --- a/arch/arm/mach-at91/include/mach/at91_pmc.h +++ b/arch/arm/mach-at91/include/mach/at91_pmc.h @@ -66,9 +66,17 @@ #define AT91_CKGR_PLLAR 0x28 /* PLL A Register */ #define AT91_CKGR_PLLBR 0x2c /* PLL B Register */ #define AT91_PMC_DIV (0xff << 0) /* Divider */ +#define AT91_PMC_DIV_BYPASS (1 << 0) /* Divider bypass */ #define AT91_PMC_PLLCOUNT (0x3f << 8) /* PLL Counter */ #define AT91_PMC_OUT (3 << 14) /* PLL Clock Frequency Range */ +#define AT91_PMC_OUT_0 (0 << 14) +#define AT91_PMC_OUT_1 (1 << 14) +#define AT91_PMC_OUT_2 (2 << 14) +#define AT91_PMC_OUT_3 (3 << 14) #define AT91_PMC_MUL (0x7ff << 16) /* PLL Multiplier */ +#define AT91_PMC_MUL_(n) (((n) << 16) & AT91_PMC_MUL) +#define AT91_PMC3_MUL (0x7f << 18) /* PLL Multiplier [SAMA5 only]*/ +#define AT91_PMC3_MUL_(n) (((n) << 18) & AT91_PMC3_MUL) #define AT91_PMC_USBDIV (3 << 28) /* USB Divisor (PLLB only) */ #define AT91_PMC_USBDIV_1 (0 << 28) #define AT91_PMC_USBDIV_2 (1 << 28) diff --git a/arch/arm/mach-at91/include/mach/sama5d3.h b/arch/arm/mach-at91/include/mach/sama5d3.h index f0e53610c6c0..da6e825593e6 100644 --- a/arch/arm/mach-at91/include/mach/sama5d3.h +++ b/arch/arm/mach-at91/include/mach/sama5d3.h @@ -87,6 +87,7 @@ #define SAMA5D3_BASE_PIOC 0xfffff600 #define SAMA5D3_BASE_PIOD 0xfffff800 #define SAMA5D3_BASE_PIOE 0xfffffa00 +#define SAMA5D3_BASE_PMC 0xfffffc00 #define SAMA5D3_BASE_MPDDRC 0xffffea00 #define SAMA5D3_BASE_HSMC 0xffffc000 #define SAMA5D3_BASE_RSTC 0xfffffe00 diff --git a/images/Makefile.at91 b/images/Makefile.at91 index 3f1dd57f6c58..3c3be0a30f66 100644 --- a/images/Makefile.at91 +++ b/images/Makefile.at91 @@ -14,6 +14,11 @@ pblb-$(CONFIG_MACH_MICROCHIP_KSZ9477_EVB) += start_sama5d3_xplained_ung8071 FILE_barebox-microchip-ksz9477-evb.img = start_sama5d3_xplained_ung8071.pblb at91-barebox-$(CONFIG_MACH_MICROCHIP_KSZ9477_EVB) += barebox-microchip-ksz9477-evb.img +pblb-$(CONFIG_MACH_MICROCHIP_KSZ9477_EVB) += start_sama5d3_xplained_ung8071_boot_bin +MAX_PBL_IMAGE_SIZE_start_sama5d3_xplained_ung8071_boot_bin = 0x10000 +FILE_barebox-microchip-ksz9477-evb-boot.bin.img = start_sama5d3_xplained_ung8071_boot_bin.pblb +at91-boot-bin-$(CONFIG_MACH_MICROCHIP_KSZ9477_EVB) += barebox-microchip-ksz9477-evb-boot.bin.img + ifdef CONFIG_AT91_LOAD_BAREBOX_SRAM image-y += $(at91-boot-bin-y) else -- 2.20.1 _______________________________________________ barebox mailing list [email protected] http://lists.infradead.org/mailman/listinfo/barebox
