ArmPkg/PL34xDmc: Remove magic values in PL310L2Cache and clean the code
git-svn-id: https://edk2.svn.sourceforge.net/svnroot/edk2/trunk/edk2@11736 6f19259b-4bc3-4df7-8a09-765794883524
This commit is contained in:
@@ -16,358 +16,206 @@
|
||||
#include <Library/DebugLib.h>
|
||||
#include <Drivers/PL341Dmc.h>
|
||||
|
||||
//
|
||||
// DMC Configuration Register Map
|
||||
//
|
||||
#define DMC_STATUS_REG 0x00
|
||||
#define DMC_COMMAND_REG 0x04
|
||||
#define DMC_DIRECT_CMD_REG 0x08
|
||||
#define DMC_MEMORY_CONFIG_REG 0x0C
|
||||
#define DMC_REFRESH_PRD_REG 0x10
|
||||
#define DMC_CAS_LATENCY_REG 0x14
|
||||
#define DMC_WRITE_LATENCY_REG 0x18
|
||||
#define DMC_T_MRD_REG 0x1C
|
||||
#define DMC_T_RAS_REG 0x20
|
||||
#define DMC_T_RC_REG 0x24
|
||||
#define DMC_T_RCD_REG 0x28
|
||||
#define DMC_T_RFC_REG 0x2C
|
||||
#define DMC_T_RP_REG 0x30
|
||||
#define DMC_T_RRD_REG 0x34
|
||||
#define DMC_T_WR_REG 0x38
|
||||
#define DMC_T_WTR_REG 0x3C
|
||||
#define DMC_T_XP_REG 0x40
|
||||
#define DMC_T_XSR_REG 0x44
|
||||
#define DMC_T_ESR_REG 0x48
|
||||
#define DMC_MEMORY_CFG2_REG 0x4C
|
||||
#define DMC_MEMORY_CFG3_REG 0x50
|
||||
#define DMC_T_FAW_REG 0x54
|
||||
|
||||
// Returns the state of the memory controller:
|
||||
#define DMC_STATUS_CONFIG 0x0
|
||||
#define DMC_STATUS_READY 0x1
|
||||
#define DMC_STATUS_PAUSED 0x2
|
||||
#define DMC_STATUS_LOWPOWER 0x3
|
||||
|
||||
// Changes the state of the memory controller:
|
||||
#define DMC_COMMAND_GO 0x0
|
||||
#define DMC_COMMAND_SLEEP 0x1
|
||||
#define DMC_COMMAND_WAKEUP 0x2
|
||||
#define DMC_COMMAND_PAUSE 0x3
|
||||
#define DMC_COMMAND_CONFIGURE 0x4
|
||||
#define DMC_COMMAND_ACTIVEPAUSE 0x7
|
||||
|
||||
// Determines the command required
|
||||
#define DMC_DIRECT_CMD_MEMCMD_PRECHARGEALL 0x0
|
||||
#define DMC_DIRECT_CMD_MEMCMD_AUTOREFRESH (0x1 << 18)
|
||||
#define DMC_DIRECT_CMD_MEMCMD_MODEREG (0x2 << 18)
|
||||
#define DMC_DIRECT_CMD_MEMCMD_EXTMODEREG (0x2 << 18)
|
||||
#define DMC_DIRECT_CMD_MEMCMD_NOP (0x3 << 18)
|
||||
#define DMC_DIRECT_CMD_MEMCMD_DPD (0x1 << 22)
|
||||
#define DMC_DIRECT_CMD_BANKADDR(n) ((n & 0x3) << 16)
|
||||
#define DMC_DIRECT_CMD_CHIP_ADDR(n) ((n & 0x3) << 20)
|
||||
|
||||
|
||||
//
|
||||
// AXI ID configuration register map
|
||||
//
|
||||
#define DMC_ID_0_CFG_REG 0x100
|
||||
#define DMC_ID_1_CFG_REG 0x104
|
||||
#define DMC_ID_2_CFG_REG 0x108
|
||||
#define DMC_ID_3_CFG_REG 0x10C
|
||||
#define DMC_ID_4_CFG_REG 0x110
|
||||
#define DMC_ID_5_CFG_REG 0x114
|
||||
#define DMC_ID_6_CFG_REG 0x118
|
||||
#define DMC_ID_7_CFG_REG 0x11C
|
||||
#define DMC_ID_8_CFG_REG 0x120
|
||||
#define DMC_ID_9_CFG_REG 0x124
|
||||
#define DMC_ID_10_CFG_REG 0x128
|
||||
#define DMC_ID_11_CFG_REG 0x12C
|
||||
#define DMC_ID_12_CFG_REG 0x130
|
||||
#define DMC_ID_13_CFG_REG 0x134
|
||||
#define DMC_ID_14_CFG_REG 0x138
|
||||
#define DMC_ID_15_CFG_REG 0x13C
|
||||
|
||||
// Set the QoS
|
||||
#define DMC_ID_CFG_QOS_DISABLE 0
|
||||
#define DMC_ID_CFG_QOS_ENABLE 1
|
||||
#define DMC_ID_CFG_QOS_MIN 2
|
||||
|
||||
|
||||
//
|
||||
// Chip configuration register map
|
||||
//
|
||||
#define DMC_CHIP_0_CFG_REG 0x200
|
||||
#define DMC_CHIP_1_CFG_REG 0x204
|
||||
#define DMC_CHIP_2_CFG_REG 0x208
|
||||
#define DMC_CHIP_3_CFG_REG 0x20C
|
||||
|
||||
//
|
||||
// User Defined Pins
|
||||
//
|
||||
#define DMC_USER_STATUS_REG 0x300
|
||||
#define DMC_USER_0_CFG_REG 0x304
|
||||
#define DMC_USER_1_CFG_REG 0x308
|
||||
#define DMC_FEATURE_CRTL_REG 0x30C
|
||||
#define DMC_USER_2_CFG_REG 0x310
|
||||
|
||||
|
||||
//
|
||||
// PHY Register Settings
|
||||
//
|
||||
#define TC_UIOLHNC_MASK 0x000003C0
|
||||
#define TC_UIOLHNC_SHIFT 0x6
|
||||
#define TC_UIOLHPC_MASK 0x0000003F
|
||||
#define TC_UIOLHPC_SHIFT 0x2
|
||||
#define TC_UIOHOCT_MASK 0x2
|
||||
#define TC_UIOHOCT_SHIFT 0x1
|
||||
#define TC_UIOHSTOP_SHIFT 0x0
|
||||
#define TC_UIOLHXC_VALUE 0x4
|
||||
|
||||
//
|
||||
// Extended Mode Register settings
|
||||
//
|
||||
#define DDR_EMR_OCD_MASK 0x0000380
|
||||
#define DDR_EMR_OCD_SHIFT 0x7
|
||||
#define DDR_EMR_RTT_MASK 0x00000044 // DDR2 Device RTT (ODT) settings
|
||||
#define DDR_EMR_RTT_SHIFT 0x2
|
||||
#define DDR_EMR_ODS_MASK 0x00000002 // DDR2 Output Drive Strength
|
||||
#define DDR_EMR_ODS_SHIFT 0x0001
|
||||
// Termination Values:
|
||||
#define DDR_EMR_RTT_50 0x00000044 // DDR2 50 Ohm termination
|
||||
#define DDR_EMR_RTT_75R 0x00000004 // DDR2 75 Ohm termination
|
||||
#define DDR_EMR_RTT_150 0x00000040 // DDR2 150 Ohm termination
|
||||
// Output Drive Strength Values:
|
||||
#define DDR_EMR_ODS_FULL 0x0 // DDR2 Full Drive Strength
|
||||
#define DDR_EMR_ODS_HALF 0x1 // DDR2 Half Drive Strength
|
||||
// OCD values
|
||||
#define DDR_EMR_OCD_DEFAULT 0x7
|
||||
#define DDR_EMR_OCD_NS 0x0
|
||||
|
||||
#define DDR_EMR_ODS_VAL DDR_EMR_ODS_FULL
|
||||
|
||||
|
||||
|
||||
// Macros for writing to DDR2 controller.
|
||||
#define DmcWriteReg(reg,val) MmioWrite32(DmcBase + reg, val)
|
||||
#define DmcReadReg(reg) MmioRead32(DmcBase + reg)
|
||||
|
||||
// Initialize PL341 Dynamic Memory Controller
|
||||
VOID PL341DmcInit(struct pl341_dmc_config *config) {
|
||||
UINTN DmcBase = config->base;
|
||||
UINT32 i, chip, val32;
|
||||
// Macros for writing/reading to DDR2 PHY controller
|
||||
#define DmcPhyWriteReg(reg,val) MmioWrite32(DmcPhyBase + reg, val)
|
||||
#define DmcPhyReadReg(reg) MmioRead32(DmcPhyBase + reg)
|
||||
|
||||
// Set config mode
|
||||
DmcWriteReg(DMC_COMMAND_REG, DMC_COMMAND_CONFIGURE);
|
||||
// Initialise PL341 Dynamic Memory Controller
|
||||
VOID
|
||||
PL341DmcInit (
|
||||
IN PL341_DMC_CONFIG *DmcConfig
|
||||
)
|
||||
{
|
||||
UINTN DmcBase;
|
||||
UINTN Index;
|
||||
UINT32 Chip;
|
||||
|
||||
DmcBase = DmcConfig->base;
|
||||
|
||||
// Set config mode
|
||||
DmcWriteReg(DMC_COMMAND_REG, DMC_COMMAND_CONFIGURE);
|
||||
|
||||
//
|
||||
// Setup the QoS AXI ID bits
|
||||
//
|
||||
if (DmcConfig->HasQos) {
|
||||
// CLCD AXIID = 000
|
||||
DmcWriteReg(DMC_ID_0_CFG_REG, DMC_ID_CFG_QOS_ENABLE | DMC_ID_CFG_QOS_MIN);
|
||||
|
||||
// Default disable QoS
|
||||
DmcWriteReg(DMC_ID_1_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_2_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_3_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_4_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_5_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_6_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_7_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_8_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_9_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_10_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_11_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_12_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_13_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_14_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_15_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
}
|
||||
|
||||
//
|
||||
// Initialise memory controlller
|
||||
//
|
||||
DmcWriteReg(DMC_REFRESH_PRD_REG, DmcConfig->refresh_prd);
|
||||
DmcWriteReg(DMC_CAS_LATENCY_REG, DmcConfig->cas_latency);
|
||||
DmcWriteReg(DMC_WRITE_LATENCY_REG, DmcConfig->write_latency);
|
||||
DmcWriteReg(DMC_T_MRD_REG, DmcConfig->t_mrd);
|
||||
DmcWriteReg(DMC_T_RAS_REG, DmcConfig->t_ras);
|
||||
DmcWriteReg(DMC_T_RC_REG, DmcConfig->t_rc);
|
||||
DmcWriteReg(DMC_T_RCD_REG, DmcConfig->t_rcd);
|
||||
DmcWriteReg(DMC_T_RFC_REG, DmcConfig->t_rfc);
|
||||
DmcWriteReg(DMC_T_RP_REG, DmcConfig->t_rp);
|
||||
DmcWriteReg(DMC_T_RRD_REG, DmcConfig->t_rrd);
|
||||
DmcWriteReg(DMC_T_WR_REG, DmcConfig->t_wr);
|
||||
DmcWriteReg(DMC_T_WTR_REG, DmcConfig->t_wtr);
|
||||
DmcWriteReg(DMC_T_XP_REG, DmcConfig->t_xp);
|
||||
DmcWriteReg(DMC_T_XSR_REG, DmcConfig->t_xsr);
|
||||
DmcWriteReg(DMC_T_ESR_REG, DmcConfig->t_esr);
|
||||
DmcWriteReg(DMC_T_FAW_REG, DmcConfig->t_faw);
|
||||
DmcWriteReg(DMC_T_WRLAT_DIFF, DmcConfig->t_wdata_en);
|
||||
DmcWriteReg(DMC_T_RDATA_EN, DmcConfig->t_data_en);
|
||||
|
||||
//
|
||||
// Initialise PL341 Mem Config Registers
|
||||
//
|
||||
|
||||
// Set PL341 Memory Config
|
||||
DmcWriteReg(DMC_MEMORY_CONFIG_REG, DmcConfig->MemoryCfg);
|
||||
|
||||
// Set PL341 Memory Config 2
|
||||
DmcWriteReg(DMC_MEMORY_CFG2_REG, DmcConfig->MemoryCfg2);
|
||||
|
||||
// Set PL341 Chip Select <n>
|
||||
DmcWriteReg(DMC_CHIP_0_CFG_REG, DmcConfig->ChipCfg0);
|
||||
DmcWriteReg(DMC_CHIP_1_CFG_REG, DmcConfig->ChipCfg1);
|
||||
DmcWriteReg(DMC_CHIP_2_CFG_REG, DmcConfig->ChipCfg2);
|
||||
DmcWriteReg(DMC_CHIP_3_CFG_REG, DmcConfig->ChipCfg3);
|
||||
|
||||
// Delay
|
||||
for (Index = 0; Index < 10; Index++) {
|
||||
DmcReadReg(DMC_STATUS_REG);
|
||||
}
|
||||
|
||||
// Set PL341 Memory Config 3
|
||||
DmcWriteReg(DMC_MEMORY_CFG3_REG, DmcConfig->MemoryCfg3);
|
||||
|
||||
if (DmcConfig->IsUserCfg) {
|
||||
//
|
||||
// Set Test Chip PHY Registers via PL341 User Config Reg
|
||||
// Note that user_cfgX registers are Write Only
|
||||
//
|
||||
// DLL Freq set = 250MHz - 266MHz
|
||||
//
|
||||
DmcWriteReg(DMC_USER_0_CFG_REG, DmcConfig->User0Cfg);
|
||||
|
||||
// user_config2
|
||||
// ------------
|
||||
// Set defaults before calibrating the DDR2 buffer impendence
|
||||
// - Disable ODT
|
||||
// - Default drive strengths
|
||||
DmcWriteReg(DMC_USER_2_CFG_REG, 0x40000198);
|
||||
|
||||
//
|
||||
// Setup the QoS AXI ID bits
|
||||
// Auto calibrate the DDR2 buffers impendence
|
||||
//
|
||||
while (!(DmcReadReg(DMC_USER_STATUS_REG) & 0x100));
|
||||
|
||||
if (config->has_qos) {
|
||||
// CLCD AXIID = 000
|
||||
DmcWriteReg(DMC_ID_0_CFG_REG, DMC_ID_CFG_QOS_ENABLE | DMC_ID_CFG_QOS_MIN);
|
||||
// Set the output driven strength
|
||||
DmcWriteReg(DMC_USER_2_CFG_REG, 0x40800000 | DmcConfig->User2Cfg);
|
||||
|
||||
// Default disable QoS
|
||||
DmcWriteReg(DMC_ID_1_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_2_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_3_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_4_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_5_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_6_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_7_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_8_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_9_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_10_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_11_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_12_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_13_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_14_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
DmcWriteReg(DMC_ID_15_CFG_REG, DMC_ID_CFG_QOS_DISABLE);
|
||||
//
|
||||
// Set PL341 Feature Control Register
|
||||
//
|
||||
// Disable early BRESP - use to optimise CLCD performance
|
||||
DmcWriteReg(DMC_FEATURE_CRTL_REG, 0x00000001);
|
||||
}
|
||||
|
||||
//
|
||||
// Config memories
|
||||
//
|
||||
for (Chip = 0; Chip < DmcConfig->MaxChip; Chip++) {
|
||||
// Send nop
|
||||
DmcWriteReg(DMC_DIRECT_CMD_REG, DMC_DIRECT_CMD_CHIP_ADDR(Chip) | DMC_DIRECT_CMD_MEMCMD_NOP);
|
||||
|
||||
// Pre-charge all
|
||||
DmcWriteReg(DMC_DIRECT_CMD_REG, DMC_DIRECT_CMD_CHIP_ADDR(Chip) | DMC_DIRECT_CMD_MEMCMD_PRECHARGEALL);
|
||||
|
||||
// Delay
|
||||
for (Index = 0; Index < 10; Index++) {
|
||||
DmcReadReg(DMC_STATUS_REG);
|
||||
}
|
||||
|
||||
// Set (EMR2) extended mode register 2
|
||||
DmcWriteReg(DMC_DIRECT_CMD_REG,
|
||||
DMC_DIRECT_CMD_CHIP_ADDR(Chip) |
|
||||
DMC_DIRECT_CMD_BANKADDR(2) |
|
||||
DMC_DIRECT_CMD_MEMCMD_EXTMODEREG);
|
||||
|
||||
// Set (EMR3) extended mode register 3
|
||||
DmcWriteReg(DMC_DIRECT_CMD_REG,
|
||||
DMC_DIRECT_CMD_CHIP_ADDR(Chip) |
|
||||
DMC_DIRECT_CMD_BANKADDR(3) |
|
||||
DMC_DIRECT_CMD_MEMCMD_EXTMODEREG);
|
||||
|
||||
//
|
||||
// Set (EMR) Extended Mode Register
|
||||
//
|
||||
// Put into OCD default state
|
||||
DmcWriteReg(DMC_DIRECT_CMD_REG,DMC_DIRECT_CMD_CHIP_ADDR(Chip) | DMC_DIRECT_CMD_BANKADDR(1) | DMC_DIRECT_CMD_MEMCMD_EXTMODEREG);
|
||||
|
||||
//
|
||||
// Set (MR) mode register - With DLL reset
|
||||
//
|
||||
DmcWriteReg(DMC_DIRECT_CMD_REG, DMC_DIRECT_CMD_CHIP_ADDR(Chip) | DMC_DIRECT_CMD_MEMCMD_EXTMODEREG | DmcConfig->ModeReg | DDR2_MR_DLL_RESET);
|
||||
|
||||
// Pre-charge all
|
||||
DmcWriteReg(DMC_DIRECT_CMD_REG, DMC_DIRECT_CMD_CHIP_ADDR(Chip) | DMC_DIRECT_CMD_MEMCMD_PRECHARGEALL);
|
||||
// Auto-refresh
|
||||
DmcWriteReg(DMC_DIRECT_CMD_REG, DMC_DIRECT_CMD_CHIP_ADDR(Chip) | DMC_DIRECT_CMD_MEMCMD_AUTOREFRESH);
|
||||
// Auto-refresh
|
||||
DmcWriteReg(DMC_DIRECT_CMD_REG, DMC_DIRECT_CMD_CHIP_ADDR(Chip) | DMC_DIRECT_CMD_MEMCMD_AUTOREFRESH);
|
||||
|
||||
//
|
||||
// Set (MR) mode register - Without DLL reset
|
||||
//
|
||||
DmcWriteReg(DMC_DIRECT_CMD_REG, DMC_DIRECT_CMD_CHIP_ADDR(Chip) | DMC_DIRECT_CMD_MEMCMD_EXTMODEREG | DmcConfig->ModeReg);
|
||||
|
||||
// Delay
|
||||
for (Index = 0; Index < 10; Index++) {
|
||||
DmcReadReg(DMC_STATUS_REG);
|
||||
}
|
||||
|
||||
//
|
||||
// Initialise memory controlller
|
||||
// Set (EMR) extended mode register - Enable OCD defaults
|
||||
//
|
||||
DmcWriteReg(DMC_REFRESH_PRD_REG, config->refresh_prd);
|
||||
DmcWriteReg(DMC_CAS_LATENCY_REG, config->cas_latency);
|
||||
DmcWriteReg(DMC_WRITE_LATENCY_REG, config->write_latency);
|
||||
DmcWriteReg(DMC_T_MRD_REG, config->t_mrd);
|
||||
DmcWriteReg(DMC_T_RAS_REG, config->t_ras);
|
||||
DmcWriteReg(DMC_T_RC_REG, config->t_rc);
|
||||
DmcWriteReg(DMC_T_RCD_REG, config->t_rcd);
|
||||
DmcWriteReg(DMC_T_RFC_REG, config->t_rfc);
|
||||
DmcWriteReg(DMC_T_RP_REG, config->t_rp);
|
||||
DmcWriteReg(DMC_T_RRD_REG, config->t_rrd);
|
||||
DmcWriteReg(DMC_T_WR_REG, config->t_wr);
|
||||
DmcWriteReg(DMC_T_WTR_REG, config->t_wtr);
|
||||
DmcWriteReg(DMC_T_XP_REG, config->t_xp);
|
||||
DmcWriteReg(DMC_T_XSR_REG, config->t_xsr);
|
||||
DmcWriteReg(DMC_T_ESR_REG, config->t_esr);
|
||||
DmcWriteReg(DMC_T_FAW_REG, config->t_faw);
|
||||
|
||||
// =======================================================================
|
||||
// Initialise PL341 Mem Config Registers
|
||||
// =======================================================================
|
||||
|
||||
// |======================================
|
||||
// | Set PL341 Memory Config
|
||||
// |======================================
|
||||
DmcWriteReg(DMC_MEMORY_CONFIG_REG, config->memory_cfg);
|
||||
|
||||
// |======================================
|
||||
// | Set PL341 Memory Config 2
|
||||
// |======================================
|
||||
DmcWriteReg(DMC_MEMORY_CFG2_REG, config->memory_cfg2);
|
||||
|
||||
// |======================================
|
||||
// | Set PL341 Chip Select <n>
|
||||
// |======================================
|
||||
DmcWriteReg(DMC_CHIP_0_CFG_REG, config->chip_cfg0);
|
||||
DmcWriteReg(DMC_CHIP_1_CFG_REG, config->chip_cfg1);
|
||||
DmcWriteReg(DMC_CHIP_2_CFG_REG, config->chip_cfg2);
|
||||
DmcWriteReg(DMC_CHIP_3_CFG_REG, config->chip_cfg3);
|
||||
|
||||
// |======================================
|
||||
// | Set PL341 Memory Config 3
|
||||
// |======================================
|
||||
DmcWriteReg(DMC_MEMORY_CFG3_REG, config->memory_cfg3);
|
||||
|
||||
// |========================================================
|
||||
// |Set Test Chip PHY Registers via PL341 User Config Reg
|
||||
// |Note that user_cfgX registers are Write Only
|
||||
// |
|
||||
// |DLL Freq set = 250MHz - 266MHz
|
||||
// |========================================================
|
||||
DmcWriteReg(DMC_USER_0_CFG_REG, 0x7C924924);
|
||||
|
||||
// user_config2
|
||||
// ------------
|
||||
// Set defaults before calibrating the DDR2 buffer impendence
|
||||
// -Disable ODT
|
||||
// -Default drive strengths
|
||||
DmcWriteReg(DMC_USER_2_CFG_REG, 0x40000198);
|
||||
|
||||
// |=======================================================
|
||||
// |Auto calibrate the DDR2 buffers impendence
|
||||
// |=======================================================
|
||||
val32 = DmcReadReg(DMC_USER_STATUS_REG);
|
||||
while (!(val32 & 0x100)) {
|
||||
val32 = DmcReadReg(DMC_USER_STATUS_REG);
|
||||
}
|
||||
|
||||
// Set the output driven strength
|
||||
DmcWriteReg(DMC_USER_2_CFG_REG, 0x40800000 |
|
||||
(TC_UIOLHXC_VALUE << TC_UIOLHNC_SHIFT) |
|
||||
(TC_UIOLHXC_VALUE << TC_UIOLHPC_SHIFT) |
|
||||
(0x1 << TC_UIOHOCT_SHIFT) |
|
||||
(0x1 << TC_UIOHSTOP_SHIFT));
|
||||
|
||||
// |======================================
|
||||
// | Set PL341 Feature Control Register
|
||||
// |======================================
|
||||
// | Disable early BRESP - use to optimise CLCD performance
|
||||
DmcWriteReg(DMC_FEATURE_CRTL_REG, 0x00000001);
|
||||
|
||||
//=================
|
||||
// Config memories
|
||||
//=================
|
||||
|
||||
for (chip = 0; chip <= config-> max_chip; chip++) {
|
||||
// send nop
|
||||
DmcWriteReg(DMC_DIRECT_CMD_REG, DMC_DIRECT_CMD_CHIP_ADDR(chip) | DMC_DIRECT_CMD_MEMCMD_NOP);
|
||||
// pre-charge all
|
||||
DmcWriteReg(DMC_DIRECT_CMD_REG, DMC_DIRECT_CMD_CHIP_ADDR(chip) | DMC_DIRECT_CMD_MEMCMD_PRECHARGEALL);
|
||||
|
||||
// delay
|
||||
for (i = 0; i < 10; i++) {
|
||||
val32 = DmcReadReg(DMC_STATUS_REG);
|
||||
}
|
||||
|
||||
// set (EMR2) extended mode register 2
|
||||
DmcWriteReg(DMC_DIRECT_CMD_REG,
|
||||
DMC_DIRECT_CMD_CHIP_ADDR(chip) |
|
||||
DMC_DIRECT_CMD_BANKADDR(2) |
|
||||
DMC_DIRECT_CMD_MEMCMD_EXTMODEREG);
|
||||
// set (EMR3) extended mode register 3
|
||||
DmcWriteReg(DMC_DIRECT_CMD_REG,
|
||||
DMC_DIRECT_CMD_CHIP_ADDR(chip) |
|
||||
DMC_DIRECT_CMD_BANKADDR(3) |
|
||||
DMC_DIRECT_CMD_MEMCMD_EXTMODEREG);
|
||||
|
||||
// =================================
|
||||
// set (EMR) Extended Mode Register
|
||||
// ==================================
|
||||
// Put into OCD default state
|
||||
DmcWriteReg(DMC_DIRECT_CMD_REG,
|
||||
DMC_DIRECT_CMD_CHIP_ADDR(chip) |
|
||||
DMC_DIRECT_CMD_BANKADDR(1) |
|
||||
DMC_DIRECT_CMD_MEMCMD_EXTMODEREG);
|
||||
|
||||
// ===========================================================
|
||||
// set (MR) mode register - With DLL reset
|
||||
// ===========================================================
|
||||
// Burst Length = 4 (010)
|
||||
// Burst Type = Seq (0)
|
||||
// Latency = 4 (100)
|
||||
// Test mode = Off (0)
|
||||
// DLL reset = Yes (1)
|
||||
// Wr Recovery = 4 (011)
|
||||
// PD = Normal (0)
|
||||
DmcWriteReg(DMC_DIRECT_CMD_REG, DMC_DIRECT_CMD_CHIP_ADDR(chip) | 0x00080742);
|
||||
|
||||
// pre-charge all
|
||||
DmcWriteReg(DMC_DIRECT_CMD_REG, DMC_DIRECT_CMD_CHIP_ADDR(chip) | DMC_DIRECT_CMD_MEMCMD_PRECHARGEALL);
|
||||
// auto-refresh
|
||||
DmcWriteReg(DMC_DIRECT_CMD_REG, DMC_DIRECT_CMD_CHIP_ADDR(chip) | DMC_DIRECT_CMD_MEMCMD_AUTOREFRESH);
|
||||
// auto-refresh
|
||||
DmcWriteReg(DMC_DIRECT_CMD_REG, DMC_DIRECT_CMD_CHIP_ADDR(chip) | DMC_DIRECT_CMD_MEMCMD_AUTOREFRESH);
|
||||
|
||||
// delay
|
||||
for (i = 0; i < 10; i++) {
|
||||
val32 = DmcReadReg(DMC_STATUS_REG);
|
||||
}
|
||||
|
||||
// ===========================================================
|
||||
// set (MR) mode register - Without DLL reset
|
||||
// ===========================================================
|
||||
// auto-refresh
|
||||
DmcWriteReg(DMC_DIRECT_CMD_REG, DMC_DIRECT_CMD_CHIP_ADDR(chip) | DMC_DIRECT_CMD_MEMCMD_AUTOREFRESH);
|
||||
DmcWriteReg(DMC_DIRECT_CMD_REG, DMC_DIRECT_CMD_CHIP_ADDR(chip) | 0x00080642);
|
||||
|
||||
// delay
|
||||
for (i = 0; i < 10; i++) {
|
||||
val32 = DmcReadReg(DMC_STATUS_REG);
|
||||
}
|
||||
|
||||
// ======================================================
|
||||
// set (EMR) extended mode register - Enable OCD defaults
|
||||
// ======================================================
|
||||
val32 = 0; //NOP
|
||||
DmcWriteReg(DMC_DIRECT_CMD_REG, DMC_DIRECT_CMD_CHIP_ADDR(chip) | 0x00090000 |
|
||||
(DDR_EMR_OCD_DEFAULT << DDR_EMR_OCD_SHIFT) |
|
||||
DDR_EMR_RTT_75R |
|
||||
(DDR_EMR_ODS_VAL << DDR_EMR_ODS_MASK));
|
||||
|
||||
// delay
|
||||
for (i = 0; i < 10; i++) {
|
||||
val32 = DmcReadReg(DMC_STATUS_REG);
|
||||
}
|
||||
|
||||
// Set (EMR) extended mode register - OCD Exit
|
||||
val32 = 0; //NOP
|
||||
DmcWriteReg(DMC_DIRECT_CMD_REG, DMC_DIRECT_CMD_CHIP_ADDR(chip) | 0x00090000 |
|
||||
(DDR_EMR_OCD_NS << DDR_EMR_OCD_SHIFT) |
|
||||
DDR_EMR_RTT_75R |
|
||||
(DDR_EMR_ODS_VAL << DDR_EMR_ODS_MASK));
|
||||
DmcWriteReg(DMC_DIRECT_CMD_REG, DMC_DIRECT_CMD_CHIP_ADDR(Chip) | (0x00090000) |
|
||||
(1 << DDR_MODESET_SHFT) | (DDR_EMR_OCD_DEFAULT << DDR_EMR_OCD_SHIFT) | DmcConfig->ExtModeReg);
|
||||
|
||||
// Delay
|
||||
for (Index = 0; Index < 10; Index++) {
|
||||
DmcReadReg(DMC_STATUS_REG);
|
||||
}
|
||||
|
||||
//----------------------------------------
|
||||
// go command
|
||||
DmcWriteReg(DMC_COMMAND_REG, DMC_COMMAND_GO);
|
||||
// Set (EMR) extended mode register - OCD Exit
|
||||
DmcWriteReg(DMC_DIRECT_CMD_REG, DMC_DIRECT_CMD_CHIP_ADDR(Chip) | (0x00090000) |
|
||||
(1 << DDR_MODESET_SHFT) | (DDR_EMR_OCD_NS << DDR_EMR_OCD_SHIFT) | DmcConfig->ExtModeReg);
|
||||
}
|
||||
|
||||
// Move DDR2 Controller to Ready state by issueing GO command
|
||||
DmcWriteReg(DMC_COMMAND_REG, DMC_COMMAND_GO);
|
||||
|
||||
// wait for ready
|
||||
while (!(DmcReadReg(DMC_STATUS_REG) & DMC_STATUS_READY));
|
||||
|
||||
// wait for ready
|
||||
val32 = DmcReadReg(DMC_STATUS_REG);
|
||||
while (!(val32 & DMC_STATUS_READY)) {
|
||||
val32 = DmcReadReg(DMC_STATUS_REG);
|
||||
}
|
||||
}
|
||||
|
Reference in New Issue
Block a user