171 lines
		
	
	
		
			4.7 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			171 lines
		
	
	
		
			4.7 KiB
		
	
	
	
		
			C
		
	
	
	
// SPDX-License-Identifier: GPL-2.0
 | 
						|
/*
 | 
						|
 * Copyright (C) 2019 Intel Corporation <www.intel.com>
 | 
						|
 *
 | 
						|
 */
 | 
						|
 | 
						|
#include <common.h>
 | 
						|
#include <dm.h>
 | 
						|
#include <errno.h>
 | 
						|
#include <div64.h>
 | 
						|
#include <fdtdec.h>
 | 
						|
#include <hang.h>
 | 
						|
#include <log.h>
 | 
						|
#include <ram.h>
 | 
						|
#include <reset.h>
 | 
						|
#include "sdram_soc64.h"
 | 
						|
#include <wait_bit.h>
 | 
						|
#include <asm/arch/firewall.h>
 | 
						|
#include <asm/arch/reset_manager.h>
 | 
						|
#include <asm/arch/system_manager.h>
 | 
						|
#include <asm/io.h>
 | 
						|
#include <linux/sizes.h>
 | 
						|
 | 
						|
DECLARE_GLOBAL_DATA_PTR;
 | 
						|
 | 
						|
int sdram_mmr_init_full(struct udevice *dev)
 | 
						|
{
 | 
						|
	struct altera_sdram_plat *plat = dev_get_plat(dev);
 | 
						|
	struct altera_sdram_priv *priv = dev_get_priv(dev);
 | 
						|
	u32 i;
 | 
						|
	int ret;
 | 
						|
	phys_size_t hw_size;
 | 
						|
	struct bd_info bd = {0};
 | 
						|
 | 
						|
	/* Ensure HMC clock is running */
 | 
						|
	if (poll_hmc_clock_status()) {
 | 
						|
		debug("DDR: Error as HMC clock was not running\n");
 | 
						|
		return -EPERM;
 | 
						|
	}
 | 
						|
 | 
						|
	/* Trying 3 times to do a calibration */
 | 
						|
	for (i = 0; i < 3; i++) {
 | 
						|
		ret = wait_for_bit_le32((const void *)(plat->hmc +
 | 
						|
					DDRCALSTAT),
 | 
						|
					DDR_HMC_DDRCALSTAT_CAL_MSK, true, 1000,
 | 
						|
					false);
 | 
						|
		if (!ret)
 | 
						|
			break;
 | 
						|
 | 
						|
		emif_reset(plat);
 | 
						|
	}
 | 
						|
 | 
						|
	if (ret) {
 | 
						|
		puts("DDR: Error as SDRAM calibration failed\n");
 | 
						|
		return -EPERM;
 | 
						|
	}
 | 
						|
	debug("DDR: Calibration success\n");
 | 
						|
 | 
						|
	/*
 | 
						|
	 * Configure the DDR IO size
 | 
						|
	 * niosreserve0: Used to indicate DDR width &
 | 
						|
	 *	bit[7:0] = Number of data bits (bit[6:5] 0x01=32bit, 0x10=64bit)
 | 
						|
	 *	bit[8]   = 1 if user-mode OCT is present
 | 
						|
	 *	bit[9]   = 1 if warm reset compiled into EMIF Cal Code
 | 
						|
	 *	bit[10]  = 1 if warm reset is on during generation in EMIF Cal
 | 
						|
	 * niosreserve1: IP ADCDS version encoded as 16 bit value
 | 
						|
	 *	bit[2:0] = Variant (0=not special,1=FAE beta, 2=Customer beta,
 | 
						|
	 *			    3=EAP, 4-6 are reserved)
 | 
						|
	 *	bit[5:3] = Service Pack # (e.g. 1)
 | 
						|
	 *	bit[9:6] = Minor Release #
 | 
						|
	 *	bit[14:10] = Major Release #
 | 
						|
	 */
 | 
						|
	/* Configure DDR IO size x16, x32 and x64 mode */
 | 
						|
	u32 update_value;
 | 
						|
 | 
						|
	update_value = hmc_readl(plat, NIOSRESERVED0);
 | 
						|
	update_value = (update_value & 0xFF) >> 5;
 | 
						|
 | 
						|
	/* Configure DDR data rate 0-HAlf-rate 1-Quarter-rate */
 | 
						|
	update_value |= (hmc_readl(plat, CTRLCFG3) & 0x4);
 | 
						|
	hmc_ecc_writel(plat, update_value, DDRIOCTRL);
 | 
						|
 | 
						|
	/* Copy values MMR IOHMC dramaddrw to HMC adp DRAMADDRWIDTH */
 | 
						|
	hmc_ecc_writel(plat, hmc_readl(plat, DRAMADDRW), DRAMADDRWIDTH);
 | 
						|
 | 
						|
	/* assigning the SDRAM size */
 | 
						|
	phys_size_t size = sdram_calculate_size(plat);
 | 
						|
 | 
						|
	if (size <= 0)
 | 
						|
		hw_size = PHYS_SDRAM_1_SIZE;
 | 
						|
	else
 | 
						|
		hw_size = size;
 | 
						|
 | 
						|
	/* Get bank configuration from devicetree */
 | 
						|
	ret = fdtdec_decode_ram_size(gd->fdt_blob, NULL, 0, NULL,
 | 
						|
				     (phys_size_t *)&gd->ram_size, &bd);
 | 
						|
	if (ret) {
 | 
						|
		puts("DDR: Failed to decode memory node\n");
 | 
						|
		return -ENXIO;
 | 
						|
	}
 | 
						|
 | 
						|
	if (gd->ram_size != hw_size) {
 | 
						|
		printf("DDR: Warning: DRAM size from device tree (%lld MiB)\n",
 | 
						|
		       gd->ram_size >> 20);
 | 
						|
		printf(" mismatch with hardware (%lld MiB).\n",
 | 
						|
		       hw_size >> 20);
 | 
						|
	}
 | 
						|
 | 
						|
	if (gd->ram_size > hw_size) {
 | 
						|
		printf("DDR: Error: DRAM size from device tree is greater\n");
 | 
						|
		printf(" than hardware size.\n");
 | 
						|
		hang();
 | 
						|
	}
 | 
						|
 | 
						|
	printf("DDR: %lld MiB\n", gd->ram_size >> 20);
 | 
						|
 | 
						|
	/* This enables nonsecure access to DDR */
 | 
						|
	/* mpuregion0addr_limit */
 | 
						|
	FW_MPU_DDR_SCR_WRITEL(gd->ram_size - 1,
 | 
						|
			      FW_MPU_DDR_SCR_MPUREGION0ADDR_LIMIT);
 | 
						|
	FW_MPU_DDR_SCR_WRITEL(0x1F, FW_MPU_DDR_SCR_MPUREGION0ADDR_LIMITEXT);
 | 
						|
 | 
						|
	/* nonmpuregion0addr_limit */
 | 
						|
	FW_MPU_DDR_SCR_WRITEL(gd->ram_size - 1,
 | 
						|
			      FW_MPU_DDR_SCR_NONMPUREGION0ADDR_LIMIT);
 | 
						|
 | 
						|
	/* Enable mpuregion0enable and nonmpuregion0enable */
 | 
						|
	FW_MPU_DDR_SCR_WRITEL(MPUREGION0_ENABLE | NONMPUREGION0_ENABLE,
 | 
						|
			      FW_MPU_DDR_SCR_EN_SET);
 | 
						|
 | 
						|
	u32 ctrlcfg1 = hmc_readl(plat, CTRLCFG1);
 | 
						|
 | 
						|
	/* Enable or disable the DDR ECC */
 | 
						|
	if (CTRLCFG1_CFG_CTRL_EN_ECC(ctrlcfg1)) {
 | 
						|
		setbits_le32(plat->hmc + ECCCTRL1,
 | 
						|
			     (DDR_HMC_ECCCTL_AWB_CNT_RST_SET_MSK |
 | 
						|
			      DDR_HMC_ECCCTL_CNT_RST_SET_MSK |
 | 
						|
			      DDR_HMC_ECCCTL_ECC_EN_SET_MSK));
 | 
						|
		clrbits_le32(plat->hmc + ECCCTRL1,
 | 
						|
			     (DDR_HMC_ECCCTL_AWB_CNT_RST_SET_MSK |
 | 
						|
			      DDR_HMC_ECCCTL_CNT_RST_SET_MSK));
 | 
						|
		setbits_le32(plat->hmc + ECCCTRL2,
 | 
						|
			     (DDR_HMC_ECCCTL2_RMW_EN_SET_MSK |
 | 
						|
			      DDR_HMC_ECCCTL2_AWB_EN_SET_MSK));
 | 
						|
		setbits_le32(plat->hmc + ERRINTEN,
 | 
						|
			     DDR_HMC_ERRINTEN_DERRINTEN_EN_SET_MSK);
 | 
						|
 | 
						|
		if (!cpu_has_been_warmreset())
 | 
						|
			sdram_init_ecc_bits(&bd);
 | 
						|
	} else {
 | 
						|
		clrbits_le32(plat->hmc + ECCCTRL1,
 | 
						|
			     (DDR_HMC_ECCCTL_AWB_CNT_RST_SET_MSK |
 | 
						|
			      DDR_HMC_ECCCTL_CNT_RST_SET_MSK |
 | 
						|
			      DDR_HMC_ECCCTL_ECC_EN_SET_MSK));
 | 
						|
		clrbits_le32(plat->hmc + ECCCTRL2,
 | 
						|
			     (DDR_HMC_ECCCTL2_RMW_EN_SET_MSK |
 | 
						|
			      DDR_HMC_ECCCTL2_AWB_EN_SET_MSK));
 | 
						|
	}
 | 
						|
 | 
						|
	/* Enable non-secure reads/writes to HMC Adapter for SDRAM ECC */
 | 
						|
	writel(FW_HMC_ADAPTOR_MPU_MASK, FW_HMC_ADAPTOR_REG_ADDR);
 | 
						|
 | 
						|
	sdram_size_check(&bd);
 | 
						|
 | 
						|
	priv->info.base = bd.bi_dram[0].start;
 | 
						|
	priv->info.size = gd->ram_size;
 | 
						|
 | 
						|
	debug("DDR: HMC init success\n");
 | 
						|
	return 0;
 | 
						|
}
 |