ddr3_init.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * Copyright (C) Marvell International Ltd. and its affiliates
  4. */
  5. #include <common.h>
  6. #include <i2c.h>
  7. #include <spl.h>
  8. #include <asm/io.h>
  9. #include <asm/arch/cpu.h>
  10. #include <asm/arch/soc.h>
  11. #include "ddr3_init.h"
  12. #include "../../../../arch/arm/mach-mvebu/serdes/a38x/sys_env_lib.h"
  13. static struct dlb_config ddr3_dlb_config_table[] = {
  14. {REG_STATIC_DRAM_DLB_CONTROL, 0x2000005c},
  15. {DLB_BUS_OPTIMIZATION_WEIGHTS_REG, 0x00880000},
  16. {DLB_AGING_REGISTER, 0x0f7f007f},
  17. {DLB_EVICTION_CONTROL_REG, 0x0000129f},
  18. {DLB_EVICTION_TIMERS_REGISTER_REG, 0x00ff0000},
  19. {DLB_BUS_WEIGHTS_DIFF_CS, 0x04030802},
  20. {DLB_BUS_WEIGHTS_DIFF_BG, 0x00000a02},
  21. {DLB_BUS_WEIGHTS_SAME_BG, 0x09000a01},
  22. {DLB_BUS_WEIGHTS_RD_WR, 0x00020005},
  23. {DLB_BUS_WEIGHTS_ATTR_SYS_PRIO, 0x00060f10},
  24. {DLB_MAIN_QUEUE_MAP, 0x00000543},
  25. {DLB_LINE_SPLIT, 0x00000000},
  26. {DLB_USER_COMMAND_REG, 0x00000000},
  27. {0x0, 0x0}
  28. };
  29. static struct dlb_config ddr3_dlb_config_table_a0[] = {
  30. {REG_STATIC_DRAM_DLB_CONTROL, 0x2000005c},
  31. {DLB_BUS_OPTIMIZATION_WEIGHTS_REG, 0x00880000},
  32. {DLB_AGING_REGISTER, 0x0f7f007f},
  33. {DLB_EVICTION_CONTROL_REG, 0x0000129f},
  34. {DLB_EVICTION_TIMERS_REGISTER_REG, 0x00ff0000},
  35. {DLB_BUS_WEIGHTS_DIFF_CS, 0x04030802},
  36. {DLB_BUS_WEIGHTS_DIFF_BG, 0x00000a02},
  37. {DLB_BUS_WEIGHTS_SAME_BG, 0x09000a01},
  38. {DLB_BUS_WEIGHTS_RD_WR, 0x00020005},
  39. {DLB_BUS_WEIGHTS_ATTR_SYS_PRIO, 0x00060f10},
  40. {DLB_MAIN_QUEUE_MAP, 0x00000543},
  41. {DLB_LINE_SPLIT, 0x00000000},
  42. {DLB_USER_COMMAND_REG, 0x00000000},
  43. {0x0, 0x0}
  44. };
  45. #if defined(CONFIG_ARMADA_38X)
  46. struct dram_modes {
  47. char *mode_name;
  48. u8 cpu_freq;
  49. u8 fab_freq;
  50. u8 chip_id;
  51. u8 chip_board_rev;
  52. struct reg_data *regs;
  53. };
  54. struct dram_modes ddr_modes[] = {
  55. };
  56. #endif /* defined(CONFIG_ARMADA_38X) */
  57. /* Translates topology map definitions to real memory size in bits */
  58. u32 mem_size[] = {
  59. ADDR_SIZE_512MB, ADDR_SIZE_1GB, ADDR_SIZE_2GB, ADDR_SIZE_4GB,
  60. ADDR_SIZE_8GB
  61. };
  62. static char *ddr_type = "DDR3";
  63. /*
  64. * Set 1 to use dynamic DUNIT configuration,
  65. * set 0 (supported for A380 and AC3) to configure DUNIT in values set by
  66. * ddr3_tip_init_specific_reg_config
  67. */
  68. u8 generic_init_controller = 1;
  69. static int ddr3_hws_tune_training_params(u8 dev_num);
  70. /* device revision */
  71. #define DEV_VERSION_ID_REG 0x1823c
  72. #define REVISON_ID_OFFS 8
  73. #define REVISON_ID_MASK 0xf00
  74. /* A38x revisions */
  75. #define MV_88F68XX_Z1_ID 0x0
  76. #define MV_88F68XX_A0_ID 0x4
  77. /* A39x revisions */
  78. #define MV_88F69XX_Z1_ID 0x2
  79. /*
  80. * sys_env_dlb_config_ptr_get
  81. *
  82. * DESCRIPTION: defines pointer to to DLB COnfiguration table
  83. *
  84. * INPUT: none
  85. *
  86. * OUTPUT: pointer to DLB COnfiguration table
  87. *
  88. * RETURN:
  89. * returns pointer to DLB COnfiguration table
  90. */
  91. struct dlb_config *sys_env_dlb_config_ptr_get(void)
  92. {
  93. #ifdef CONFIG_ARMADA_39X
  94. return &ddr3_dlb_config_table_a0[0];
  95. #else
  96. if (sys_env_device_rev_get() == MV_88F68XX_A0_ID)
  97. return &ddr3_dlb_config_table_a0[0];
  98. else
  99. return &ddr3_dlb_config_table[0];
  100. #endif
  101. }
  102. /*
  103. * sys_env_get_cs_ena_from_reg
  104. *
  105. * DESCRIPTION: Get bit mask of enabled CS
  106. *
  107. * INPUT: None
  108. *
  109. * OUTPUT: None
  110. *
  111. * RETURN:
  112. * Bit mask of enabled CS, 1 if only CS0 enabled,
  113. * 3 if both CS0 and CS1 enabled
  114. */
  115. u32 sys_env_get_cs_ena_from_reg(void)
  116. {
  117. return reg_read(REG_DDR3_RANK_CTRL_ADDR) &
  118. REG_DDR3_RANK_CTRL_CS_ENA_MASK;
  119. }
  120. static void ddr3_restore_and_set_final_windows(u32 *win)
  121. {
  122. u32 win_ctrl_reg, num_of_win_regs;
  123. u32 cs_ena = sys_env_get_cs_ena_from_reg();
  124. u32 ui;
  125. win_ctrl_reg = REG_XBAR_WIN_4_CTRL_ADDR;
  126. num_of_win_regs = 16;
  127. /* Return XBAR windows 4-7 or 16-19 init configuration */
  128. for (ui = 0; ui < num_of_win_regs; ui++)
  129. reg_write((win_ctrl_reg + 0x4 * ui), win[ui]);
  130. printf("%s Training Sequence - Switching XBAR Window to FastPath Window\n",
  131. ddr_type);
  132. #if defined DYNAMIC_CS_SIZE_CONFIG
  133. if (ddr3_fast_path_dynamic_cs_size_config(cs_ena) != MV_OK)
  134. printf("ddr3_fast_path_dynamic_cs_size_config FAILED\n");
  135. #else
  136. u32 reg, cs;
  137. reg = 0x1fffffe1;
  138. for (cs = 0; cs < MAX_CS; cs++) {
  139. if (cs_ena & (1 << cs)) {
  140. reg |= (cs << 2);
  141. break;
  142. }
  143. }
  144. /* Open fast path Window to - 0.5G */
  145. reg_write(REG_FASTPATH_WIN_0_CTRL_ADDR, reg);
  146. #endif
  147. }
  148. static int ddr3_save_and_set_training_windows(u32 *win)
  149. {
  150. u32 cs_ena;
  151. u32 reg, tmp_count, cs, ui;
  152. u32 win_ctrl_reg, win_base_reg, win_remap_reg;
  153. u32 num_of_win_regs, win_jump_index;
  154. win_ctrl_reg = REG_XBAR_WIN_4_CTRL_ADDR;
  155. win_base_reg = REG_XBAR_WIN_4_BASE_ADDR;
  156. win_remap_reg = REG_XBAR_WIN_4_REMAP_ADDR;
  157. win_jump_index = 0x10;
  158. num_of_win_regs = 16;
  159. struct hws_topology_map *tm = ddr3_get_topology_map();
  160. #ifdef DISABLE_L2_FILTERING_DURING_DDR_TRAINING
  161. /*
  162. * Disable L2 filtering during DDR training
  163. * (when Cross Bar window is open)
  164. */
  165. reg_write(ADDRESS_FILTERING_END_REGISTER, 0);
  166. #endif
  167. cs_ena = tm->interface_params[0].as_bus_params[0].cs_bitmask;
  168. /* Close XBAR Window 19 - Not needed */
  169. /* {0x000200e8} - Open Mbus Window - 2G */
  170. reg_write(REG_XBAR_WIN_19_CTRL_ADDR, 0);
  171. /* Save XBAR Windows 4-19 init configurations */
  172. for (ui = 0; ui < num_of_win_regs; ui++)
  173. win[ui] = reg_read(win_ctrl_reg + 0x4 * ui);
  174. /* Open XBAR Windows 4-7 or 16-19 for other CS */
  175. reg = 0;
  176. tmp_count = 0;
  177. for (cs = 0; cs < MAX_CS; cs++) {
  178. if (cs_ena & (1 << cs)) {
  179. switch (cs) {
  180. case 0:
  181. reg = 0x0e00;
  182. break;
  183. case 1:
  184. reg = 0x0d00;
  185. break;
  186. case 2:
  187. reg = 0x0b00;
  188. break;
  189. case 3:
  190. reg = 0x0700;
  191. break;
  192. }
  193. reg |= (1 << 0);
  194. reg |= (SDRAM_CS_SIZE & 0xffff0000);
  195. reg_write(win_ctrl_reg + win_jump_index * tmp_count,
  196. reg);
  197. reg = (((SDRAM_CS_SIZE + 1) * (tmp_count)) &
  198. 0xffff0000);
  199. reg_write(win_base_reg + win_jump_index * tmp_count,
  200. reg);
  201. if (win_remap_reg <= REG_XBAR_WIN_7_REMAP_ADDR)
  202. reg_write(win_remap_reg +
  203. win_jump_index * tmp_count, 0);
  204. tmp_count++;
  205. }
  206. }
  207. return MV_OK;
  208. }
  209. /*
  210. * Name: ddr3_init - Main DDR3 Init function
  211. * Desc: This routine initialize the DDR3 MC and runs HW training.
  212. * Args: None.
  213. * Notes:
  214. * Returns: None.
  215. */
  216. int ddr3_init(void)
  217. {
  218. u32 reg = 0;
  219. u32 soc_num;
  220. int status;
  221. u32 win[16];
  222. /* SoC/Board special Initializtions */
  223. /* Get version from internal library */
  224. ddr3_print_version();
  225. /*Add sub_version string */
  226. DEBUG_INIT_C("", SUB_VERSION, 1);
  227. /* Switching CPU to MRVL ID */
  228. soc_num = (reg_read(REG_SAMPLE_RESET_HIGH_ADDR) & SAR1_CPU_CORE_MASK) >>
  229. SAR1_CPU_CORE_OFFSET;
  230. switch (soc_num) {
  231. case 0x3:
  232. case 0x1:
  233. reg_bit_set(CPU_CONFIGURATION_REG(1), CPU_MRVL_ID_OFFSET);
  234. case 0x0:
  235. reg_bit_set(CPU_CONFIGURATION_REG(0), CPU_MRVL_ID_OFFSET);
  236. default:
  237. break;
  238. }
  239. /*
  240. * Set DRAM Reset Mask in case detected GPIO indication of wakeup from
  241. * suspend i.e the DRAM values will not be overwritten / reset when
  242. * waking from suspend
  243. */
  244. if (sys_env_suspend_wakeup_check() ==
  245. SUSPEND_WAKEUP_ENABLED_GPIO_DETECTED) {
  246. reg_bit_set(REG_SDRAM_INIT_CTRL_ADDR,
  247. 1 << REG_SDRAM_INIT_RESET_MASK_OFFS);
  248. }
  249. /*
  250. * Stage 0 - Set board configuration
  251. */
  252. /* Check if DRAM is already initialized */
  253. if (reg_read(REG_BOOTROM_ROUTINE_ADDR) &
  254. (1 << REG_BOOTROM_ROUTINE_DRAM_INIT_OFFS)) {
  255. printf("%s Training Sequence - 2nd boot - Skip\n", ddr_type);
  256. return MV_OK;
  257. }
  258. /*
  259. * Stage 1 - Dunit Setup
  260. */
  261. /* Fix read ready phases for all SOC in reg 0x15c8 */
  262. reg = reg_read(REG_TRAINING_DEBUG_3_ADDR);
  263. reg &= ~(REG_TRAINING_DEBUG_3_MASK);
  264. reg |= 0x4; /* Phase 0 */
  265. reg &= ~(REG_TRAINING_DEBUG_3_MASK << REG_TRAINING_DEBUG_3_OFFS);
  266. reg |= (0x4 << (1 * REG_TRAINING_DEBUG_3_OFFS)); /* Phase 1 */
  267. reg &= ~(REG_TRAINING_DEBUG_3_MASK << (3 * REG_TRAINING_DEBUG_3_OFFS));
  268. reg |= (0x6 << (3 * REG_TRAINING_DEBUG_3_OFFS)); /* Phase 3 */
  269. reg &= ~(REG_TRAINING_DEBUG_3_MASK << (4 * REG_TRAINING_DEBUG_3_OFFS));
  270. reg |= (0x6 << (4 * REG_TRAINING_DEBUG_3_OFFS));
  271. reg &= ~(REG_TRAINING_DEBUG_3_MASK << (5 * REG_TRAINING_DEBUG_3_OFFS));
  272. reg |= (0x6 << (5 * REG_TRAINING_DEBUG_3_OFFS));
  273. reg_write(REG_TRAINING_DEBUG_3_ADDR, reg);
  274. /*
  275. * Axi_bresp_mode[8] = Compliant,
  276. * Axi_addr_decode_cntrl[11] = Internal,
  277. * Axi_data_bus_width[0] = 128bit
  278. * */
  279. /* 0x14a8 - AXI Control Register */
  280. reg_write(REG_DRAM_AXI_CTRL_ADDR, 0);
  281. /*
  282. * Stage 2 - Training Values Setup
  283. */
  284. /* Set X-BAR windows for the training sequence */
  285. ddr3_save_and_set_training_windows(win);
  286. /* Tune training algo paramteres */
  287. status = ddr3_hws_tune_training_params(0);
  288. if (MV_OK != status)
  289. return status;
  290. /* Set log level for training lib */
  291. ddr3_hws_set_log_level(DEBUG_BLOCK_ALL, DEBUG_LEVEL_ERROR);
  292. /* Start New Training IP */
  293. status = ddr3_hws_hw_training();
  294. if (MV_OK != status) {
  295. printf("%s Training Sequence - FAILED\n", ddr_type);
  296. return status;
  297. }
  298. /*
  299. * Stage 3 - Finish
  300. */
  301. /* Restore and set windows */
  302. ddr3_restore_and_set_final_windows(win);
  303. /* Update DRAM init indication in bootROM register */
  304. reg = reg_read(REG_BOOTROM_ROUTINE_ADDR);
  305. reg_write(REG_BOOTROM_ROUTINE_ADDR,
  306. reg | (1 << REG_BOOTROM_ROUTINE_DRAM_INIT_OFFS));
  307. /* DLB config */
  308. ddr3_new_tip_dlb_config();
  309. #if defined(ECC_SUPPORT)
  310. if (ddr3_if_ecc_enabled())
  311. ddr3_new_tip_ecc_scrub();
  312. #endif
  313. printf("%s Training Sequence - Ended Successfully\n", ddr_type);
  314. return MV_OK;
  315. }
  316. /*
  317. * Name: ddr3_get_cpu_freq
  318. * Desc: read S@R and return CPU frequency
  319. * Args:
  320. * Notes:
  321. * Returns: required value
  322. */
  323. u32 ddr3_get_cpu_freq(void)
  324. {
  325. return ddr3_tip_get_init_freq();
  326. }
  327. /*
  328. * Name: ddr3_get_fab_opt
  329. * Desc: read S@R and return CPU frequency
  330. * Args:
  331. * Notes:
  332. * Returns: required value
  333. */
  334. u32 ddr3_get_fab_opt(void)
  335. {
  336. return 0; /* No fabric */
  337. }
  338. /*
  339. * Name: ddr3_get_static_m_cValue - Init Memory controller with
  340. * static parameters
  341. * Desc: Use this routine to init the controller without the HW training
  342. * procedure.
  343. * User must provide compatible header file with registers data.
  344. * Args: None.
  345. * Notes:
  346. * Returns: None.
  347. */
  348. u32 ddr3_get_static_mc_value(u32 reg_addr, u32 offset1, u32 mask1,
  349. u32 offset2, u32 mask2)
  350. {
  351. u32 reg, temp;
  352. reg = reg_read(reg_addr);
  353. temp = (reg >> offset1) & mask1;
  354. if (mask2)
  355. temp |= (reg >> offset2) & mask2;
  356. return temp;
  357. }
  358. /*
  359. * Name: ddr3_get_static_ddr_mode - Init Memory controller with
  360. * static parameters
  361. * Desc: Use this routine to init the controller without the HW training
  362. * procedure.
  363. * User must provide compatible header file with registers data.
  364. * Args: None.
  365. * Notes:
  366. * Returns: None.
  367. */
  368. u32 ddr3_get_static_ddr_mode(void)
  369. {
  370. u32 chip_board_rev, i;
  371. u32 size;
  372. /* Valid only for A380 only, MSYS using dynamic controller config */
  373. #ifdef CONFIG_CUSTOMER_BOARD_SUPPORT
  374. /*
  375. * Customer boards select DDR mode according to
  376. * board ID & Sample@Reset
  377. */
  378. chip_board_rev = mv_board_id_get();
  379. #else
  380. /* Marvell boards select DDR mode according to Sample@Reset only */
  381. chip_board_rev = MARVELL_BOARD;
  382. #endif
  383. size = ARRAY_SIZE(ddr_modes);
  384. for (i = 0; i < size; i++) {
  385. if ((ddr3_get_cpu_freq() == ddr_modes[i].cpu_freq) &&
  386. (ddr3_get_fab_opt() == ddr_modes[i].fab_freq) &&
  387. (chip_board_rev == ddr_modes[i].chip_board_rev))
  388. return i;
  389. }
  390. DEBUG_INIT_S("\n*** Error: ddr3_get_static_ddr_mode: No match for requested DDR mode. ***\n\n");
  391. return 0;
  392. }
  393. /******************************************************************************
  394. * Name: ddr3_get_cs_num_from_reg
  395. * Desc:
  396. * Args:
  397. * Notes:
  398. * Returns:
  399. */
  400. u32 ddr3_get_cs_num_from_reg(void)
  401. {
  402. u32 cs_ena = sys_env_get_cs_ena_from_reg();
  403. u32 cs_count = 0;
  404. u32 cs;
  405. for (cs = 0; cs < MAX_CS; cs++) {
  406. if (cs_ena & (1 << cs))
  407. cs_count++;
  408. }
  409. return cs_count;
  410. }
  411. void get_target_freq(u32 freq_mode, u32 *ddr_freq, u32 *hclk_ps)
  412. {
  413. u32 tmp, hclk = 200;
  414. switch (freq_mode) {
  415. case 4:
  416. tmp = 1; /* DDR_400; */
  417. hclk = 200;
  418. break;
  419. case 0x8:
  420. tmp = 1; /* DDR_666; */
  421. hclk = 333;
  422. break;
  423. case 0xc:
  424. tmp = 1; /* DDR_800; */
  425. hclk = 400;
  426. break;
  427. default:
  428. *ddr_freq = 0;
  429. *hclk_ps = 0;
  430. break;
  431. }
  432. *ddr_freq = tmp; /* DDR freq define */
  433. *hclk_ps = 1000000 / hclk; /* values are 1/HCLK in ps */
  434. return;
  435. }
  436. void ddr3_new_tip_dlb_config(void)
  437. {
  438. u32 reg, i = 0;
  439. struct dlb_config *config_table_ptr = sys_env_dlb_config_ptr_get();
  440. /* Write the configuration */
  441. while (config_table_ptr[i].reg_addr != 0) {
  442. reg_write(config_table_ptr[i].reg_addr,
  443. config_table_ptr[i].reg_data);
  444. i++;
  445. }
  446. /* Enable DLB */
  447. reg = reg_read(REG_STATIC_DRAM_DLB_CONTROL);
  448. reg |= DLB_ENABLE | DLB_WRITE_COALESING | DLB_AXI_PREFETCH_EN |
  449. DLB_MBUS_PREFETCH_EN | PREFETCH_N_LN_SZ_TR;
  450. reg_write(REG_STATIC_DRAM_DLB_CONTROL, reg);
  451. }
  452. int ddr3_fast_path_dynamic_cs_size_config(u32 cs_ena)
  453. {
  454. u32 reg, cs;
  455. u32 mem_total_size = 0;
  456. u32 cs_mem_size = 0;
  457. u32 mem_total_size_c, cs_mem_size_c;
  458. #ifdef DEVICE_MAX_DRAM_ADDRESS_SIZE
  459. u32 physical_mem_size;
  460. u32 max_mem_size = DEVICE_MAX_DRAM_ADDRESS_SIZE;
  461. struct hws_topology_map *tm = ddr3_get_topology_map();
  462. #endif
  463. /* Open fast path windows */
  464. for (cs = 0; cs < MAX_CS; cs++) {
  465. if (cs_ena & (1 << cs)) {
  466. /* get CS size */
  467. if (ddr3_calc_mem_cs_size(cs, &cs_mem_size) != MV_OK)
  468. return MV_FAIL;
  469. #ifdef DEVICE_MAX_DRAM_ADDRESS_SIZE
  470. /*
  471. * if number of address pins doesn't allow to use max
  472. * mem size that is defined in topology
  473. * mem size is defined by DEVICE_MAX_DRAM_ADDRESS_SIZE
  474. */
  475. physical_mem_size = mem_size
  476. [tm->interface_params[0].memory_size];
  477. if (ddr3_get_device_width(cs) == 16) {
  478. /*
  479. * 16bit mem device can be twice more - no need
  480. * in less significant pin
  481. */
  482. max_mem_size = DEVICE_MAX_DRAM_ADDRESS_SIZE * 2;
  483. }
  484. if (physical_mem_size > max_mem_size) {
  485. cs_mem_size = max_mem_size *
  486. (ddr3_get_bus_width() /
  487. ddr3_get_device_width(cs));
  488. printf("Updated Physical Mem size is from 0x%x to %x\n",
  489. physical_mem_size,
  490. DEVICE_MAX_DRAM_ADDRESS_SIZE);
  491. }
  492. #endif
  493. /* set fast path window control for the cs */
  494. reg = 0xffffe1;
  495. reg |= (cs << 2);
  496. reg |= (cs_mem_size - 1) & 0xffff0000;
  497. /*Open fast path Window */
  498. reg_write(REG_FASTPATH_WIN_CTRL_ADDR(cs), reg);
  499. /* Set fast path window base address for the cs */
  500. reg = ((cs_mem_size) * cs) & 0xffff0000;
  501. /* Set base address */
  502. reg_write(REG_FASTPATH_WIN_BASE_ADDR(cs), reg);
  503. /*
  504. * Since memory size may be bigger than 4G the summ may
  505. * be more than 32 bit word,
  506. * so to estimate the result divide mem_total_size and
  507. * cs_mem_size by 0x10000 (it is equal to >> 16)
  508. */
  509. mem_total_size_c = mem_total_size >> 16;
  510. cs_mem_size_c = cs_mem_size >> 16;
  511. /* if the sum less than 2 G - calculate the value */
  512. if (mem_total_size_c + cs_mem_size_c < 0x10000)
  513. mem_total_size += cs_mem_size;
  514. else /* put max possible size */
  515. mem_total_size = L2_FILTER_FOR_MAX_MEMORY_SIZE;
  516. }
  517. }
  518. /* Set L2 filtering to Max Memory size */
  519. reg_write(ADDRESS_FILTERING_END_REGISTER, mem_total_size);
  520. return MV_OK;
  521. }
  522. u32 ddr3_get_bus_width(void)
  523. {
  524. u32 bus_width;
  525. bus_width = (reg_read(REG_SDRAM_CONFIG_ADDR) & 0x8000) >>
  526. REG_SDRAM_CONFIG_WIDTH_OFFS;
  527. return (bus_width == 0) ? 16 : 32;
  528. }
  529. u32 ddr3_get_device_width(u32 cs)
  530. {
  531. u32 device_width;
  532. device_width = (reg_read(REG_SDRAM_ADDRESS_CTRL_ADDR) &
  533. (0x3 << (REG_SDRAM_ADDRESS_CTRL_STRUCT_OFFS * cs))) >>
  534. (REG_SDRAM_ADDRESS_CTRL_STRUCT_OFFS * cs);
  535. return (device_width == 0) ? 8 : 16;
  536. }
  537. static int ddr3_get_device_size(u32 cs)
  538. {
  539. u32 device_size_low, device_size_high, device_size;
  540. u32 data, cs_low_offset, cs_high_offset;
  541. cs_low_offset = REG_SDRAM_ADDRESS_SIZE_OFFS + cs * 4;
  542. cs_high_offset = REG_SDRAM_ADDRESS_SIZE_OFFS +
  543. REG_SDRAM_ADDRESS_SIZE_HIGH_OFFS + cs;
  544. data = reg_read(REG_SDRAM_ADDRESS_CTRL_ADDR);
  545. device_size_low = (data >> cs_low_offset) & 0x3;
  546. device_size_high = (data >> cs_high_offset) & 0x1;
  547. device_size = device_size_low | (device_size_high << 2);
  548. switch (device_size) {
  549. case 0:
  550. return 2048;
  551. case 2:
  552. return 512;
  553. case 3:
  554. return 1024;
  555. case 4:
  556. return 4096;
  557. case 5:
  558. return 8192;
  559. case 1:
  560. default:
  561. DEBUG_INIT_C("Error: Wrong device size of Cs: ", cs, 1);
  562. /*
  563. * Small value will give wrong emem size in
  564. * ddr3_calc_mem_cs_size
  565. */
  566. return 0;
  567. }
  568. }
  569. int ddr3_calc_mem_cs_size(u32 cs, u32 *cs_size)
  570. {
  571. int cs_mem_size;
  572. /* Calculate in GiB */
  573. cs_mem_size = ((ddr3_get_bus_width() / ddr3_get_device_width(cs)) *
  574. ddr3_get_device_size(cs)) / 8;
  575. /*
  576. * Multiple controller bus width, 2x for 64 bit
  577. * (SoC controller may be 32 or 64 bit,
  578. * so bit 15 in 0x1400, that means if whole bus used or only half,
  579. * have a differnt meaning
  580. */
  581. cs_mem_size *= DDR_CONTROLLER_BUS_WIDTH_MULTIPLIER;
  582. if (!cs_mem_size || (cs_mem_size == 64) || (cs_mem_size == 4096)) {
  583. DEBUG_INIT_C("Error: Wrong Memory size of Cs: ", cs, 1);
  584. return MV_BAD_VALUE;
  585. }
  586. *cs_size = cs_mem_size << 20;
  587. return MV_OK;
  588. }
  589. /*
  590. * Name: ddr3_hws_tune_training_params
  591. * Desc:
  592. * Args:
  593. * Notes: Tune internal training params
  594. * Returns:
  595. */
  596. static int ddr3_hws_tune_training_params(u8 dev_num)
  597. {
  598. struct tune_train_params params;
  599. int status;
  600. /* NOTE: do not remove any field initilization */
  601. params.ck_delay = TUNE_TRAINING_PARAMS_CK_DELAY;
  602. params.ck_delay_16 = TUNE_TRAINING_PARAMS_CK_DELAY_16;
  603. params.p_finger = TUNE_TRAINING_PARAMS_PFINGER;
  604. params.n_finger = TUNE_TRAINING_PARAMS_NFINGER;
  605. params.phy_reg3_val = TUNE_TRAINING_PARAMS_PHYREG3VAL;
  606. status = ddr3_tip_tune_training_params(dev_num, &params);
  607. if (MV_OK != status) {
  608. printf("%s Training Sequence - FAILED\n", ddr_type);
  609. return status;
  610. }
  611. return MV_OK;
  612. }