| // SPDX-License-Identifier: GPL-2.0 |
| /* |
| * Copyright (C) 2016-2017 Intel Corporation |
| */ |
| |
| #include <asm/io.h> |
| #include <asm/arch/fpga_manager.h> |
| #include <asm/arch/misc.h> |
| #include <asm/arch/reset_manager.h> |
| #include <asm/arch/system_manager.h> |
| #include <common.h> |
| #include <errno.h> |
| #include <fdtdec.h> |
| #include <wait_bit.h> |
| |
| DECLARE_GLOBAL_DATA_PTR; |
| |
| static const struct socfpga_reset_manager *reset_manager_base = |
| (void *)SOCFPGA_RSTMGR_ADDRESS; |
| static const struct socfpga_system_manager *sysmgr_regs = |
| (struct socfpga_system_manager *)SOCFPGA_SYSMGR_ADDRESS; |
| |
| #define ECC_MASK (ALT_RSTMGR_PER0MODRST_EMACECC0_SET_MSK | \ |
| ALT_RSTMGR_PER0MODRST_EMACECC1_SET_MSK | \ |
| ALT_RSTMGR_PER0MODRST_EMACECC2_SET_MSK | \ |
| ALT_RSTMGR_PER0MODRST_NANDECC_SET_MSK | \ |
| ALT_RSTMGR_PER0MODRST_QSPIECC_SET_MSK | \ |
| ALT_RSTMGR_PER0MODRST_SDMMCECC_SET_MSK) |
| |
| void socfpga_reset_uart(int assert) |
| { |
| unsigned int com_port; |
| |
| com_port = uart_com_port(gd->fdt_blob); |
| |
| if (com_port == SOCFPGA_UART1_ADDRESS) |
| socfpga_per_reset(SOCFPGA_RESET(UART1), assert); |
| else if (com_port == SOCFPGA_UART0_ADDRESS) |
| socfpga_per_reset(SOCFPGA_RESET(UART0), assert); |
| } |
| |
| static const u32 per0fpgamasks[] = { |
| ALT_RSTMGR_PER0MODRST_EMACECC0_SET_MSK | |
| ALT_RSTMGR_PER0MODRST_EMAC0_SET_MSK, |
| ALT_RSTMGR_PER0MODRST_EMACECC1_SET_MSK | |
| ALT_RSTMGR_PER0MODRST_EMAC1_SET_MSK, |
| ALT_RSTMGR_PER0MODRST_EMACECC2_SET_MSK | |
| ALT_RSTMGR_PER0MODRST_EMAC2_SET_MSK, |
| 0, /* i2c0 per1mod */ |
| 0, /* i2c1 per1mod */ |
| 0, /* i2c0_emac */ |
| 0, /* i2c1_emac */ |
| 0, /* i2c2_emac */ |
| ALT_RSTMGR_PER0MODRST_NANDECC_SET_MSK | |
| ALT_RSTMGR_PER0MODRST_NAND_SET_MSK, |
| ALT_RSTMGR_PER0MODRST_QSPIECC_SET_MSK | |
| ALT_RSTMGR_PER0MODRST_QSPI_SET_MSK, |
| ALT_RSTMGR_PER0MODRST_SDMMCECC_SET_MSK | |
| ALT_RSTMGR_PER0MODRST_SDMMC_SET_MSK, |
| ALT_RSTMGR_PER0MODRST_SPIM0_SET_MSK, |
| ALT_RSTMGR_PER0MODRST_SPIM1_SET_MSK, |
| ALT_RSTMGR_PER0MODRST_SPIS0_SET_MSK, |
| ALT_RSTMGR_PER0MODRST_SPIS1_SET_MSK, |
| 0, /* uart0 per1mod */ |
| 0, /* uart1 per1mod */ |
| }; |
| |
| static const u32 per1fpgamasks[] = { |
| 0, /* emac0 per0mod */ |
| 0, /* emac1 per0mod */ |
| 0, /* emac2 per0mod */ |
| ALT_RSTMGR_PER1MODRST_I2C0_SET_MSK, |
| ALT_RSTMGR_PER1MODRST_I2C1_SET_MSK, |
| ALT_RSTMGR_PER1MODRST_I2C2_SET_MSK, /* i2c0_emac */ |
| ALT_RSTMGR_PER1MODRST_I2C3_SET_MSK, /* i2c1_emac */ |
| ALT_RSTMGR_PER1MODRST_I2C4_SET_MSK, /* i2c2_emac */ |
| 0, /* nand per0mod */ |
| 0, /* qspi per0mod */ |
| 0, /* sdmmc per0mod */ |
| 0, /* spim0 per0mod */ |
| 0, /* spim1 per0mod */ |
| 0, /* spis0 per0mod */ |
| 0, /* spis1 per0mod */ |
| ALT_RSTMGR_PER1MODRST_UART0_SET_MSK, |
| ALT_RSTMGR_PER1MODRST_UART1_SET_MSK, |
| }; |
| |
| struct bridge_cfg { |
| int compat_id; |
| u32 mask_noc; |
| u32 mask_rstmgr; |
| }; |
| |
| static const struct bridge_cfg bridge_cfg_tbl[] = { |
| { |
| COMPAT_ALTERA_SOCFPGA_H2F_BRG, |
| ALT_SYSMGR_NOC_H2F_SET_MSK, |
| ALT_RSTMGR_BRGMODRST_H2F_SET_MSK, |
| }, |
| { |
| COMPAT_ALTERA_SOCFPGA_LWH2F_BRG, |
| ALT_SYSMGR_NOC_LWH2F_SET_MSK, |
| ALT_RSTMGR_BRGMODRST_LWH2F_SET_MSK, |
| }, |
| { |
| COMPAT_ALTERA_SOCFPGA_F2H_BRG, |
| ALT_SYSMGR_NOC_F2H_SET_MSK, |
| ALT_RSTMGR_BRGMODRST_F2H_SET_MSK, |
| }, |
| { |
| COMPAT_ALTERA_SOCFPGA_F2SDR0, |
| ALT_SYSMGR_NOC_F2SDR0_SET_MSK, |
| ALT_RSTMGR_BRGMODRST_F2SSDRAM0_SET_MSK, |
| }, |
| { |
| COMPAT_ALTERA_SOCFPGA_F2SDR1, |
| ALT_SYSMGR_NOC_F2SDR1_SET_MSK, |
| ALT_RSTMGR_BRGMODRST_F2SSDRAM1_SET_MSK, |
| }, |
| { |
| COMPAT_ALTERA_SOCFPGA_F2SDR2, |
| ALT_SYSMGR_NOC_F2SDR2_SET_MSK, |
| ALT_RSTMGR_BRGMODRST_F2SSDRAM2_SET_MSK, |
| }, |
| }; |
| |
| /* Disable the watchdog (toggle reset to watchdog) */ |
| void socfpga_watchdog_disable(void) |
| { |
| /* assert reset for watchdog */ |
| setbits_le32(&reset_manager_base->per1modrst, |
| ALT_RSTMGR_PER1MODRST_WD0_SET_MSK); |
| } |
| |
| /* Release NOC ddr scheduler from reset */ |
| void socfpga_reset_deassert_noc_ddr_scheduler(void) |
| { |
| clrbits_le32(&reset_manager_base->brgmodrst, |
| ALT_RSTMGR_BRGMODRST_DDRSCH_SET_MSK); |
| } |
| |
| /* Check whether Watchdog in reset state? */ |
| int socfpga_is_wdt_in_reset(void) |
| { |
| u32 val; |
| |
| val = readl(&reset_manager_base->per1modrst); |
| val &= ALT_RSTMGR_PER1MODRST_WD0_SET_MSK; |
| |
| /* return 0x1 if watchdog in reset */ |
| return val; |
| } |
| |
| /* emacbase: base address of emac to enable/disable reset |
| * state: 0 - disable reset, !0 - enable reset |
| */ |
| void socfpga_emac_manage_reset(ulong emacbase, u32 state) |
| { |
| ulong eccmask; |
| ulong emacmask; |
| |
| switch (emacbase) { |
| case SOCFPGA_EMAC0_ADDRESS: |
| eccmask = ALT_RSTMGR_PER0MODRST_EMACECC0_SET_MSK; |
| emacmask = ALT_RSTMGR_PER0MODRST_EMAC0_SET_MSK; |
| break; |
| case SOCFPGA_EMAC1_ADDRESS: |
| eccmask = ALT_RSTMGR_PER0MODRST_EMACECC1_SET_MSK; |
| emacmask = ALT_RSTMGR_PER0MODRST_EMAC1_SET_MSK; |
| break; |
| case SOCFPGA_EMAC2_ADDRESS: |
| eccmask = ALT_RSTMGR_PER0MODRST_EMACECC2_SET_MSK; |
| emacmask = ALT_RSTMGR_PER0MODRST_EMAC2_SET_MSK; |
| break; |
| default: |
| pr_err("emac base address unexpected! %lx", emacbase); |
| hang(); |
| break; |
| } |
| |
| if (state) { |
| /* Enable ECC OCP first */ |
| setbits_le32(&reset_manager_base->per0modrst, eccmask); |
| setbits_le32(&reset_manager_base->per0modrst, emacmask); |
| } else { |
| /* Disable ECC OCP first */ |
| clrbits_le32(&reset_manager_base->per0modrst, emacmask); |
| clrbits_le32(&reset_manager_base->per0modrst, eccmask); |
| } |
| } |
| |
| static int get_bridge_init_val(const void *blob, int compat_id) |
| { |
| int node; |
| |
| node = fdtdec_next_compatible(blob, 0, compat_id); |
| if (node < 0) |
| return 0; |
| |
| return fdtdec_get_uint(blob, node, "init-val", 0); |
| } |
| |
| /* Enable bridges (hps2fpga, lwhps2fpga, fpga2hps, fpga2sdram) per handoff */ |
| int socfpga_reset_deassert_bridges_handoff(void) |
| { |
| u32 mask_noc = 0, mask_rstmgr = 0; |
| int i; |
| |
| for (i = 0; i < ARRAY_SIZE(bridge_cfg_tbl); i++) { |
| if (get_bridge_init_val(gd->fdt_blob, |
| bridge_cfg_tbl[i].compat_id)) { |
| mask_noc |= bridge_cfg_tbl[i].mask_noc; |
| mask_rstmgr |= bridge_cfg_tbl[i].mask_rstmgr; |
| } |
| } |
| |
| /* clear idle request to all bridges */ |
| setbits_le32(&sysmgr_regs->noc_idlereq_clr, mask_noc); |
| |
| /* Release bridges from reset state per handoff value */ |
| clrbits_le32(&reset_manager_base->brgmodrst, mask_rstmgr); |
| |
| /* Poll until all idleack to 0, timeout at 1000ms */ |
| return wait_for_bit_le32(&sysmgr_regs->noc_idleack, mask_noc, |
| false, 1000, false); |
| } |
| |
| void socfpga_reset_assert_fpga_connected_peripherals(void) |
| { |
| u32 mask0 = 0; |
| u32 mask1 = 0; |
| u32 fpga_pinux_addr = SOCFPGA_PINMUX_FPGA_INTERFACE_ADDRESS; |
| int i; |
| |
| for (i = 0; i < ARRAY_SIZE(per1fpgamasks); i++) { |
| if (readl(fpga_pinux_addr)) { |
| mask0 |= per0fpgamasks[i]; |
| mask1 |= per1fpgamasks[i]; |
| } |
| fpga_pinux_addr += sizeof(u32); |
| } |
| |
| setbits_le32(&reset_manager_base->per0modrst, mask0 & ECC_MASK); |
| setbits_le32(&reset_manager_base->per1modrst, mask1); |
| setbits_le32(&reset_manager_base->per0modrst, mask0); |
| } |
| |
| /* Release L4 OSC1 Watchdog Timer 0 from reset through reset manager */ |
| void socfpga_reset_deassert_osc1wd0(void) |
| { |
| clrbits_le32(&reset_manager_base->per1modrst, |
| ALT_RSTMGR_PER1MODRST_WD0_SET_MSK); |
| } |
| |
| /* |
| * Assert or de-assert SoCFPGA reset manager reset. |
| */ |
| void socfpga_per_reset(u32 reset, int set) |
| { |
| const u32 *reg; |
| u32 rstmgr_bank = RSTMGR_BANK(reset); |
| |
| switch (rstmgr_bank) { |
| case 0: |
| reg = &reset_manager_base->mpumodrst; |
| break; |
| case 1: |
| reg = &reset_manager_base->per0modrst; |
| break; |
| case 2: |
| reg = &reset_manager_base->per1modrst; |
| break; |
| case 3: |
| reg = &reset_manager_base->brgmodrst; |
| break; |
| case 4: |
| reg = &reset_manager_base->sysmodrst; |
| break; |
| |
| default: |
| return; |
| } |
| |
| if (set) |
| setbits_le32(reg, 1 << RSTMGR_RESET(reset)); |
| else |
| clrbits_le32(reg, 1 << RSTMGR_RESET(reset)); |
| } |
| |
| /* |
| * Assert reset on every peripheral but L4WD0. |
| * Watchdog must be kept intact to prevent glitches |
| * and/or hangs. |
| * For the Arria10, we disable all the peripherals except L4 watchdog0, |
| * L4 Timer 0, and ECC. |
| */ |
| void socfpga_per_reset_all(void) |
| { |
| const u32 l4wd0 = (1 << RSTMGR_RESET(SOCFPGA_RESET(L4WD0)) | |
| (1 << RSTMGR_RESET(SOCFPGA_RESET(L4SYSTIMER0)))); |
| unsigned mask_ecc_ocp = |
| ALT_RSTMGR_PER0MODRST_EMACECC0_SET_MSK | |
| ALT_RSTMGR_PER0MODRST_EMACECC1_SET_MSK | |
| ALT_RSTMGR_PER0MODRST_EMACECC2_SET_MSK | |
| ALT_RSTMGR_PER0MODRST_USBECC0_SET_MSK | |
| ALT_RSTMGR_PER0MODRST_USBECC1_SET_MSK | |
| ALT_RSTMGR_PER0MODRST_NANDECC_SET_MSK | |
| ALT_RSTMGR_PER0MODRST_QSPIECC_SET_MSK | |
| ALT_RSTMGR_PER0MODRST_SDMMCECC_SET_MSK; |
| |
| /* disable all components except ECC_OCP, L4 Timer0 and L4 WD0 */ |
| writel(~l4wd0, &reset_manager_base->per1modrst); |
| setbits_le32(&reset_manager_base->per0modrst, ~mask_ecc_ocp); |
| |
| /* Finally disable the ECC_OCP */ |
| setbits_le32(&reset_manager_base->per0modrst, mask_ecc_ocp); |
| } |
| |
| int socfpga_bridges_reset(void) |
| { |
| int ret; |
| |
| /* Disable all the bridges (hps2fpga, lwhps2fpga, fpga2hps, |
| fpga2sdram) */ |
| /* set idle request to all bridges */ |
| writel(ALT_SYSMGR_NOC_H2F_SET_MSK | |
| ALT_SYSMGR_NOC_LWH2F_SET_MSK | |
| ALT_SYSMGR_NOC_F2H_SET_MSK | |
| ALT_SYSMGR_NOC_F2SDR0_SET_MSK | |
| ALT_SYSMGR_NOC_F2SDR1_SET_MSK | |
| ALT_SYSMGR_NOC_F2SDR2_SET_MSK, |
| &sysmgr_regs->noc_idlereq_set); |
| |
| /* Enable the NOC timeout */ |
| writel(ALT_SYSMGR_NOC_TMO_EN_SET_MSK, &sysmgr_regs->noc_timeout); |
| |
| /* Poll until all idleack to 1 */ |
| ret = wait_for_bit_le32(&sysmgr_regs->noc_idleack, |
| ALT_SYSMGR_NOC_H2F_SET_MSK | |
| ALT_SYSMGR_NOC_LWH2F_SET_MSK | |
| ALT_SYSMGR_NOC_F2H_SET_MSK | |
| ALT_SYSMGR_NOC_F2SDR0_SET_MSK | |
| ALT_SYSMGR_NOC_F2SDR1_SET_MSK | |
| ALT_SYSMGR_NOC_F2SDR2_SET_MSK, |
| true, 10000, false); |
| if (ret) |
| return ret; |
| |
| /* Poll until all idlestatus to 1 */ |
| ret = wait_for_bit_le32(&sysmgr_regs->noc_idlestatus, |
| ALT_SYSMGR_NOC_H2F_SET_MSK | |
| ALT_SYSMGR_NOC_LWH2F_SET_MSK | |
| ALT_SYSMGR_NOC_F2H_SET_MSK | |
| ALT_SYSMGR_NOC_F2SDR0_SET_MSK | |
| ALT_SYSMGR_NOC_F2SDR1_SET_MSK | |
| ALT_SYSMGR_NOC_F2SDR2_SET_MSK, |
| true, 10000, false); |
| if (ret) |
| return ret; |
| |
| /* Put all bridges (except NOR DDR scheduler) into reset state */ |
| setbits_le32(&reset_manager_base->brgmodrst, |
| (ALT_RSTMGR_BRGMODRST_H2F_SET_MSK | |
| ALT_RSTMGR_BRGMODRST_LWH2F_SET_MSK | |
| ALT_RSTMGR_BRGMODRST_F2H_SET_MSK | |
| ALT_RSTMGR_BRGMODRST_F2SSDRAM0_SET_MSK | |
| ALT_RSTMGR_BRGMODRST_F2SSDRAM1_SET_MSK | |
| ALT_RSTMGR_BRGMODRST_F2SSDRAM2_SET_MSK)); |
| |
| /* Disable NOC timeout */ |
| writel(0, &sysmgr_regs->noc_timeout); |
| |
| return 0; |
| } |