blob: 7e0749fde3f2ef917e0f61a24ca46a8f0530b8c6 [file] [log] [blame]
Stefan Roese5ffceb82015-03-26 15:36:56 +01001/*
2 * Copyright (C) Marvell International Ltd. and its affiliates
3 *
4 * SPDX-License-Identifier: GPL-2.0
5 */
6
7#include <common.h>
8#include <spl.h>
9#include <asm/io.h>
10#include <asm/arch/cpu.h>
11#include <asm/arch/soc.h>
12
13#include "ddr3_init.h"
14
15#define GET_MAX_VALUE(x, y) \
16 ((x) > (y)) ? (x) : (y)
17#define CEIL_DIVIDE(x, y) \
18 ((x - (x / y) * y) == 0) ? ((x / y) - 1) : (x / y)
19
20#define TIME_2_CLOCK_CYCLES CEIL_DIVIDE
21
22#define GET_CS_FROM_MASK(mask) (cs_mask2_num[mask])
23#define CS_CBE_VALUE(cs_num) (cs_cbe_reg[cs_num])
24
25u32 window_mem_addr = 0;
26u32 phy_reg0_val = 0;
27u32 phy_reg1_val = 8;
28u32 phy_reg2_val = 0;
29u32 phy_reg3_val = 0xa;
30enum hws_ddr_freq init_freq = DDR_FREQ_667;
31enum hws_ddr_freq low_freq = DDR_FREQ_LOW_FREQ;
32enum hws_ddr_freq medium_freq;
33u32 debug_dunit = 0;
34u32 odt_additional = 1;
35u32 *dq_map_table = NULL;
36u32 odt_config = 1;
37
38#if defined(CONFIG_ARMADA_38X) || defined(CONFIG_ALLEYCAT3) || \
39 defined(CONFIG_ARMADA_39X)
40u32 is_pll_before_init = 0, is_adll_calib_before_init = 0, is_dfs_in_init = 0;
41u32 dfs_low_freq = 130;
42#else
43u32 is_pll_before_init = 0, is_adll_calib_before_init = 1, is_dfs_in_init = 0;
44u32 dfs_low_freq = 100;
45#endif
46u32 g_rtt_nom_c_s0, g_rtt_nom_c_s1;
47u8 calibration_update_control; /* 2 external only, 1 is internal only */
48
49enum hws_result training_result[MAX_STAGE_LIMIT][MAX_INTERFACE_NUM];
50enum auto_tune_stage training_stage = INIT_CONTROLLER;
51u32 finger_test = 0, p_finger_start = 11, p_finger_end = 64,
52 n_finger_start = 11, n_finger_end = 64,
53 p_finger_step = 3, n_finger_step = 3;
54u32 clamp_tbl[] = { 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3 };
55
56/* Initiate to 0xff, this variable is define by user in debug mode */
57u32 mode2_t = 0xff;
58u32 xsb_validate_type = 0;
59u32 xsb_validation_base_address = 0xf000;
60u32 first_active_if = 0;
61u32 dfs_low_phy1 = 0x1f;
62u32 multicast_id = 0;
63int use_broadcast = 0;
64struct hws_tip_freq_config_info *freq_info_table = NULL;
65u8 is_cbe_required = 0;
66u32 debug_mode = 0;
67u32 delay_enable = 0;
68int rl_mid_freq_wa = 0;
69
70u32 effective_cs = 0;
71
72u32 mask_tune_func = (SET_MEDIUM_FREQ_MASK_BIT |
73 WRITE_LEVELING_MASK_BIT |
74 LOAD_PATTERN_2_MASK_BIT |
75 READ_LEVELING_MASK_BIT |
76 SET_TARGET_FREQ_MASK_BIT | WRITE_LEVELING_TF_MASK_BIT |
77 READ_LEVELING_TF_MASK_BIT |
78 CENTRALIZATION_RX_MASK_BIT | CENTRALIZATION_TX_MASK_BIT);
79
80void ddr3_print_version(void)
81{
82 printf(DDR3_TIP_VERSION_STRING);
83}
84
85static int ddr3_tip_ddr3_training_main_flow(u32 dev_num);
86static int ddr3_tip_write_odt(u32 dev_num, enum hws_access_type access_type,
87 u32 if_id, u32 cl_value, u32 cwl_value);
88static int ddr3_tip_ddr3_auto_tune(u32 dev_num);
89static int is_bus_access_done(u32 dev_num, u32 if_id,
90 u32 dunit_reg_adrr, u32 bit);
91#ifdef ODT_TEST_SUPPORT
92static int odt_test(u32 dev_num, enum hws_algo_type algo_type);
93#endif
94
95int adll_calibration(u32 dev_num, enum hws_access_type access_type,
96 u32 if_id, enum hws_ddr_freq frequency);
97static int ddr3_tip_set_timing(u32 dev_num, enum hws_access_type access_type,
98 u32 if_id, enum hws_ddr_freq frequency);
99
100static struct page_element page_param[] = {
101 /*
102 * 8bits 16 bits
103 * page-size(K) page-size(K) mask
104 */
105 { 1, 2, 2},
106 /* 512M */
107 { 1, 2, 3},
108 /* 1G */
109 { 1, 2, 0},
110 /* 2G */
111 { 1, 2, 4},
112 /* 4G */
113 { 2, 2, 5}
114 /* 8G */
115};
116
117static u8 mem_size_config[MEM_SIZE_LAST] = {
118 0x2, /* 512Mbit */
119 0x3, /* 1Gbit */
120 0x0, /* 2Gbit */
121 0x4, /* 4Gbit */
122 0x5 /* 8Gbit */
123};
124
125static u8 cs_mask2_num[] = { 0, 0, 1, 1, 2, 2, 2, 2, 3, 3, 3, 3, 3, 3, 3, 3 };
126
127static struct reg_data odpg_default_value[] = {
128 {0x1034, 0x38000, MASK_ALL_BITS},
129 {0x1038, 0x0, MASK_ALL_BITS},
130 {0x10b0, 0x0, MASK_ALL_BITS},
131 {0x10b8, 0x0, MASK_ALL_BITS},
132 {0x10c0, 0x0, MASK_ALL_BITS},
133 {0x10f0, 0x0, MASK_ALL_BITS},
134 {0x10f4, 0x0, MASK_ALL_BITS},
135 {0x10f8, 0xff, MASK_ALL_BITS},
136 {0x10fc, 0xffff, MASK_ALL_BITS},
137 {0x1130, 0x0, MASK_ALL_BITS},
138 {0x1830, 0x2000000, MASK_ALL_BITS},
139 {0x14d0, 0x0, MASK_ALL_BITS},
140 {0x14d4, 0x0, MASK_ALL_BITS},
141 {0x14d8, 0x0, MASK_ALL_BITS},
142 {0x14dc, 0x0, MASK_ALL_BITS},
143 {0x1454, 0x0, MASK_ALL_BITS},
144 {0x1594, 0x0, MASK_ALL_BITS},
145 {0x1598, 0x0, MASK_ALL_BITS},
146 {0x159c, 0x0, MASK_ALL_BITS},
147 {0x15a0, 0x0, MASK_ALL_BITS},
148 {0x15a4, 0x0, MASK_ALL_BITS},
149 {0x15a8, 0x0, MASK_ALL_BITS},
150 {0x15ac, 0x0, MASK_ALL_BITS},
151 {0x1604, 0x0, MASK_ALL_BITS},
152 {0x1608, 0x0, MASK_ALL_BITS},
153 {0x160c, 0x0, MASK_ALL_BITS},
154 {0x1610, 0x0, MASK_ALL_BITS},
155 {0x1614, 0x0, MASK_ALL_BITS},
156 {0x1618, 0x0, MASK_ALL_BITS},
157 {0x1624, 0x0, MASK_ALL_BITS},
158 {0x1690, 0x0, MASK_ALL_BITS},
159 {0x1694, 0x0, MASK_ALL_BITS},
160 {0x1698, 0x0, MASK_ALL_BITS},
161 {0x169c, 0x0, MASK_ALL_BITS},
162 {0x14b8, 0x6f67, MASK_ALL_BITS},
163 {0x1630, 0x0, MASK_ALL_BITS},
164 {0x1634, 0x0, MASK_ALL_BITS},
165 {0x1638, 0x0, MASK_ALL_BITS},
166 {0x163c, 0x0, MASK_ALL_BITS},
167 {0x16b0, 0x0, MASK_ALL_BITS},
168 {0x16b4, 0x0, MASK_ALL_BITS},
169 {0x16b8, 0x0, MASK_ALL_BITS},
170 {0x16bc, 0x0, MASK_ALL_BITS},
171 {0x16c0, 0x0, MASK_ALL_BITS},
172 {0x16c4, 0x0, MASK_ALL_BITS},
173 {0x16c8, 0x0, MASK_ALL_BITS},
174 {0x16cc, 0x1, MASK_ALL_BITS},
175 {0x16f0, 0x1, MASK_ALL_BITS},
176 {0x16f4, 0x0, MASK_ALL_BITS},
177 {0x16f8, 0x0, MASK_ALL_BITS},
178 {0x16fc, 0x0, MASK_ALL_BITS}
179};
180
181static int ddr3_tip_bus_access(u32 dev_num, enum hws_access_type interface_access,
182 u32 if_id, enum hws_access_type phy_access,
183 u32 phy_id, enum hws_ddr_phy phy_type, u32 reg_addr,
184 u32 data_value, enum hws_operation oper_type);
185static int ddr3_tip_pad_inv(u32 dev_num, u32 if_id);
186static int ddr3_tip_rank_control(u32 dev_num, u32 if_id);
187
188/*
189 * Update global training parameters by data from user
190 */
191int ddr3_tip_tune_training_params(u32 dev_num,
192 struct tune_train_params *params)
193{
194 if (params->ck_delay != -1)
195 ck_delay = params->ck_delay;
196 if (params->ck_delay_16 != -1)
197 ck_delay_16 = params->ck_delay_16;
198 if (params->phy_reg3_val != -1)
199 phy_reg3_val = params->phy_reg3_val;
200
201 return MV_OK;
202}
203
204/*
205 * Configure CS
206 */
207int ddr3_tip_configure_cs(u32 dev_num, u32 if_id, u32 cs_num, u32 enable)
208{
209 u32 data, addr_hi, data_high;
210 u32 mem_index;
211 struct hws_topology_map *tm = ddr3_get_topology_map();
212
213 if (enable == 1) {
214 data = (tm->interface_params[if_id].bus_width ==
215 BUS_WIDTH_8) ? 0 : 1;
216 CHECK_STATUS(ddr3_tip_if_write
217 (dev_num, ACCESS_TYPE_UNICAST, if_id,
218 SDRAM_ACCESS_CONTROL_REG, (data << (cs_num * 4)),
219 0x3 << (cs_num * 4)));
220 mem_index = tm->interface_params[if_id].memory_size;
221
222 addr_hi = mem_size_config[mem_index] & 0x3;
223 CHECK_STATUS(ddr3_tip_if_write
224 (dev_num, ACCESS_TYPE_UNICAST, if_id,
225 SDRAM_ACCESS_CONTROL_REG,
226 (addr_hi << (2 + cs_num * 4)),
227 0x3 << (2 + cs_num * 4)));
228
229 data_high = (mem_size_config[mem_index] & 0x4) >> 2;
230 CHECK_STATUS(ddr3_tip_if_write
231 (dev_num, ACCESS_TYPE_UNICAST, if_id,
232 SDRAM_ACCESS_CONTROL_REG,
233 data_high << (20 + cs_num), 1 << (20 + cs_num)));
234
235 /* Enable Address Select Mode */
236 CHECK_STATUS(ddr3_tip_if_write
237 (dev_num, ACCESS_TYPE_UNICAST, if_id,
238 SDRAM_ACCESS_CONTROL_REG, 1 << (16 + cs_num),
239 1 << (16 + cs_num)));
240 }
241 switch (cs_num) {
242 case 0:
243 case 1:
244 case 2:
245 CHECK_STATUS(ddr3_tip_if_write
246 (dev_num, ACCESS_TYPE_UNICAST, if_id,
247 DDR_CONTROL_LOW_REG, (enable << (cs_num + 11)),
248 1 << (cs_num + 11)));
249 break;
250 case 3:
251 CHECK_STATUS(ddr3_tip_if_write
252 (dev_num, ACCESS_TYPE_UNICAST, if_id,
253 DDR_CONTROL_LOW_REG, (enable << 15), 1 << 15));
254 break;
255 }
256
257 return MV_OK;
258}
259
260/*
261 * Calculate number of CS
262 */
263static int calc_cs_num(u32 dev_num, u32 if_id, u32 *cs_num)
264{
265 u32 cs;
266 u32 bus_cnt;
267 u32 cs_count;
268 u32 cs_bitmask;
269 u32 curr_cs_num = 0;
270 struct hws_topology_map *tm = ddr3_get_topology_map();
271
272 for (bus_cnt = 0; bus_cnt < GET_TOPOLOGY_NUM_OF_BUSES(); bus_cnt++) {
273 VALIDATE_ACTIVE(tm->bus_act_mask, bus_cnt);
274 cs_count = 0;
275 cs_bitmask = tm->interface_params[if_id].
276 as_bus_params[bus_cnt].cs_bitmask;
277 for (cs = 0; cs < MAX_CS_NUM; cs++) {
278 if ((cs_bitmask >> cs) & 1)
279 cs_count++;
280 }
281
282 if (curr_cs_num == 0) {
283 curr_cs_num = cs_count;
284 } else if (cs_count != curr_cs_num) {
285 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
286 ("CS number is different per bus (IF %d BUS %d cs_num %d curr_cs_num %d)\n",
287 if_id, bus_cnt, cs_count,
288 curr_cs_num));
289 return MV_NOT_SUPPORTED;
290 }
291 }
292 *cs_num = curr_cs_num;
293
294 return MV_OK;
295}
296
297/*
298 * Init Controller Flow
299 */
300int hws_ddr3_tip_init_controller(u32 dev_num, struct init_cntr_param *init_cntr_prm)
301{
302 u32 if_id;
303 u32 cs_num;
304 u32 t_refi = 0, t_hclk = 0, t_ckclk = 0, t_faw = 0, t_pd = 0,
305 t_wr = 0, t2t = 0, txpdll = 0;
306 u32 data_value = 0, bus_width = 0, page_size = 0, cs_cnt = 0,
307 mem_mask = 0, bus_index = 0;
308 enum hws_speed_bin speed_bin_index = SPEED_BIN_DDR_2133N;
309 enum hws_mem_size memory_size = MEM_2G;
310 enum hws_ddr_freq freq = init_freq;
311 u32 cs_mask = 0;
312 u32 cl_value = 0, cwl_val = 0;
313 u32 refresh_interval_cnt = 0, bus_cnt = 0, adll_tap = 0;
314 enum hws_access_type access_type = ACCESS_TYPE_UNICAST;
315 u32 data_read[MAX_INTERFACE_NUM];
316 struct hws_topology_map *tm = ddr3_get_topology_map();
317
318 DEBUG_TRAINING_IP(DEBUG_LEVEL_TRACE,
319 ("Init_controller, do_mrs_phy=%d, is_ctrl64_bit=%d\n",
320 init_cntr_prm->do_mrs_phy,
321 init_cntr_prm->is_ctrl64_bit));
322
323 if (init_cntr_prm->init_phy == 1) {
324 CHECK_STATUS(ddr3_tip_configure_phy(dev_num));
325 }
326
327 if (generic_init_controller == 1) {
328 for (if_id = 0; if_id <= MAX_INTERFACE_NUM - 1; if_id++) {
329 VALIDATE_ACTIVE(tm->if_act_mask, if_id);
330 DEBUG_TRAINING_IP(DEBUG_LEVEL_TRACE,
331 ("active IF %d\n", if_id));
332 mem_mask = 0;
333 for (bus_index = 0;
334 bus_index < GET_TOPOLOGY_NUM_OF_BUSES();
335 bus_index++) {
336 VALIDATE_ACTIVE(tm->bus_act_mask, bus_index);
337 mem_mask |=
338 tm->interface_params[if_id].
339 as_bus_params[bus_index].mirror_enable_bitmask;
340 }
341
342 if (mem_mask != 0) {
343 CHECK_STATUS(ddr3_tip_if_write
344 (dev_num, ACCESS_TYPE_MULTICAST,
345 if_id, CS_ENABLE_REG, 0,
346 0x8));
347 }
348
349 memory_size =
350 tm->interface_params[if_id].
351 memory_size;
352 speed_bin_index =
353 tm->interface_params[if_id].
354 speed_bin_index;
355 freq = init_freq;
356 t_refi =
357 (tm->interface_params[if_id].
358 interface_temp ==
359 HWS_TEMP_HIGH) ? TREFI_HIGH : TREFI_LOW;
360 t_refi *= 1000; /* psec */
361 DEBUG_TRAINING_IP(DEBUG_LEVEL_TRACE,
362 ("memy_size %d speed_bin_ind %d freq %d t_refi %d\n",
363 memory_size, speed_bin_index, freq,
364 t_refi));
365 /* HCLK & CK CLK in 2:1[ps] */
366 /* t_ckclk is external clock */
367 t_ckclk = (MEGA / freq_val[freq]);
368 /* t_hclk is internal clock */
369 t_hclk = 2 * t_ckclk;
370 refresh_interval_cnt = t_refi / t_hclk; /* no units */
371 bus_width =
372 (DDR3_IS_16BIT_DRAM_MODE(tm->bus_act_mask)
373 == 1) ? (16) : (32);
374
375 if (init_cntr_prm->is_ctrl64_bit)
376 bus_width = 64;
377
378 data_value =
379 (refresh_interval_cnt | 0x4000 |
380 ((bus_width ==
381 32) ? 0x8000 : 0) | 0x1000000) & ~(1 << 26);
382
383 /* Interface Bus Width */
384 /* SRMode */
385 CHECK_STATUS(ddr3_tip_if_write
386 (dev_num, access_type, if_id,
387 SDRAM_CONFIGURATION_REG, data_value,
388 0x100ffff));
389
390 /* Interleave first command pre-charge enable (TBD) */
391 CHECK_STATUS(ddr3_tip_if_write
392 (dev_num, access_type, if_id,
393 SDRAM_OPEN_PAGE_CONTROL_REG, (1 << 10),
394 (1 << 10)));
395
396 /* PHY configuration */
397 /*
398 * Postamble Length = 1.5cc, Addresscntl to clk skew
399 * \BD, Preamble length normal, parralal ADLL enable
400 */
401 CHECK_STATUS(ddr3_tip_if_write
402 (dev_num, access_type, if_id,
403 DRAM_PHY_CONFIGURATION, 0x28, 0x3e));
404 if (init_cntr_prm->is_ctrl64_bit) {
405 /* positive edge */
406 CHECK_STATUS(ddr3_tip_if_write
407 (dev_num, access_type, if_id,
408 DRAM_PHY_CONFIGURATION, 0x0,
409 0xff80));
410 }
411
412 /* calibration block disable */
413 /* Xbar Read buffer select (for Internal access) */
414 CHECK_STATUS(ddr3_tip_if_write
415 (dev_num, access_type, if_id,
416 CALIB_MACHINE_CTRL_REG, 0x1200c,
417 0x7dffe01c));
418 CHECK_STATUS(ddr3_tip_if_write
419 (dev_num, access_type, if_id,
420 CALIB_MACHINE_CTRL_REG,
421 calibration_update_control << 3, 0x3 << 3));
422
423 /* Pad calibration control - enable */
424 CHECK_STATUS(ddr3_tip_if_write
425 (dev_num, access_type, if_id,
426 CALIB_MACHINE_CTRL_REG, 0x1, 0x1));
427
428 cs_mask = 0;
429 data_value = 0x7;
430 /*
431 * Address ctrl \96 Part of the Generic code
432 * The next configuration is done:
433 * 1) Memory Size
434 * 2) Bus_width
435 * 3) CS#
436 * 4) Page Number
437 * 5) t_faw
438 * Per Dunit get from the Map_topology the parameters:
439 * Bus_width
440 * t_faw is per Dunit not per CS
441 */
442 page_size =
443 (tm->interface_params[if_id].
444 bus_width ==
445 BUS_WIDTH_8) ? page_param[memory_size].
446 page_size_8bit : page_param[memory_size].
447 page_size_16bit;
448
449 t_faw =
450 (page_size == 1) ? speed_bin_table(speed_bin_index,
451 SPEED_BIN_TFAW1K)
452 : speed_bin_table(speed_bin_index,
453 SPEED_BIN_TFAW2K);
454
455 data_value = TIME_2_CLOCK_CYCLES(t_faw, t_ckclk);
456 data_value = data_value << 24;
457 CHECK_STATUS(ddr3_tip_if_write
458 (dev_num, access_type, if_id,
459 SDRAM_ACCESS_CONTROL_REG, data_value,
460 0x7f000000));
461
462 data_value =
463 (tm->interface_params[if_id].
464 bus_width == BUS_WIDTH_8) ? 0 : 1;
465
466 /* create merge cs mask for all cs available in dunit */
467 for (bus_cnt = 0;
468 bus_cnt < GET_TOPOLOGY_NUM_OF_BUSES();
469 bus_cnt++) {
470 VALIDATE_ACTIVE(tm->bus_act_mask, bus_cnt);
471 cs_mask |=
472 tm->interface_params[if_id].
473 as_bus_params[bus_cnt].cs_bitmask;
474 }
475 DEBUG_TRAINING_IP(DEBUG_LEVEL_TRACE,
476 ("Init_controller IF %d cs_mask %d\n",
477 if_id, cs_mask));
478 /*
479 * Configure the next upon the Map Topology \96 If the
480 * Dunit is CS0 Configure CS0 if it is multi CS
481 * configure them both: The Bust_width it\92s the
482 * Memory Bus width \96 x8 or x16
483 */
484 for (cs_cnt = 0; cs_cnt < NUM_OF_CS; cs_cnt++) {
485 ddr3_tip_configure_cs(dev_num, if_id, cs_cnt,
486 ((cs_mask & (1 << cs_cnt)) ? 1
487 : 0));
488 }
489
490 if (init_cntr_prm->do_mrs_phy) {
491 /*
492 * MR0 \96 Part of the Generic code
493 * The next configuration is done:
494 * 1) Burst Length
495 * 2) CAS Latency
496 * get for each dunit what is it Speed_bin &
497 * Target Frequency. From those both parameters
498 * get the appropriate Cas_l from the CL table
499 */
500 cl_value =
501 tm->interface_params[if_id].
502 cas_l;
503 cwl_val =
504 tm->interface_params[if_id].
505 cas_wl;
506 DEBUG_TRAINING_IP(DEBUG_LEVEL_TRACE,
507 ("cl_value 0x%x cwl_val 0x%x\n",
508 cl_value, cwl_val));
509
510 data_value =
511 ((cl_mask_table[cl_value] & 0x1) << 2) |
512 ((cl_mask_table[cl_value] & 0xe) << 3);
513 CHECK_STATUS(ddr3_tip_if_write
514 (dev_num, access_type, if_id,
515 MR0_REG, data_value,
516 (0x7 << 4) | (1 << 2)));
517 CHECK_STATUS(ddr3_tip_if_write
518 (dev_num, access_type, if_id,
519 MR0_REG, twr_mask_table[t_wr + 1],
520 0xe00));
521
522 /*
523 * MR1: Set RTT and DIC Design GL values
524 * configured by user
525 */
526 CHECK_STATUS(ddr3_tip_if_write
527 (dev_num, ACCESS_TYPE_MULTICAST,
528 PARAM_NOT_CARE, MR1_REG,
529 g_dic | g_rtt_nom, 0x266));
530
531 /* MR2 - Part of the Generic code */
532 /*
533 * The next configuration is done:
534 * 1) SRT
535 * 2) CAS Write Latency
536 */
537 data_value = (cwl_mask_table[cwl_val] << 3);
538 data_value |=
539 ((tm->interface_params[if_id].
540 interface_temp ==
541 HWS_TEMP_HIGH) ? (1 << 7) : 0);
542 CHECK_STATUS(ddr3_tip_if_write
543 (dev_num, access_type, if_id,
544 MR2_REG, data_value,
545 (0x7 << 3) | (0x1 << 7) | (0x3 <<
546 9)));
547 }
548
549 ddr3_tip_write_odt(dev_num, access_type, if_id,
550 cl_value, cwl_val);
551 ddr3_tip_set_timing(dev_num, access_type, if_id, freq);
552
553 CHECK_STATUS(ddr3_tip_if_write
554 (dev_num, access_type, if_id,
555 DUNIT_CONTROL_HIGH_REG, 0x177,
556 0x1000177));
557
558 if (init_cntr_prm->is_ctrl64_bit) {
559 /* disable 0.25 cc delay */
560 CHECK_STATUS(ddr3_tip_if_write
561 (dev_num, access_type, if_id,
562 DUNIT_CONTROL_HIGH_REG, 0x0,
563 0x800));
564 }
565
566 /* reset bit 7 */
567 CHECK_STATUS(ddr3_tip_if_write
568 (dev_num, access_type, if_id,
569 DUNIT_CONTROL_HIGH_REG,
570 (init_cntr_prm->msys_init << 7), (1 << 7)));
571
572 if (mode2_t != 0xff) {
573 t2t = mode2_t;
574 } else {
575 /* calculate number of CS (per interface) */
576 CHECK_STATUS(calc_cs_num
577 (dev_num, if_id, &cs_num));
578 t2t = (cs_num == 1) ? 0 : 1;
579 }
580
581 CHECK_STATUS(ddr3_tip_if_write
582 (dev_num, access_type, if_id,
583 DDR_CONTROL_LOW_REG, t2t << 3,
584 0x3 << 3));
585 /* move the block to ddr3_tip_set_timing - start */
586 t_pd = GET_MAX_VALUE(t_ckclk * 3,
587 speed_bin_table(speed_bin_index,
588 SPEED_BIN_TPD));
589 t_pd = TIME_2_CLOCK_CYCLES(t_pd, t_ckclk);
590 txpdll = GET_MAX_VALUE(t_ckclk * 10, 24);
591 txpdll = CEIL_DIVIDE((txpdll - 1), t_ckclk);
592 CHECK_STATUS(ddr3_tip_if_write
593 (dev_num, access_type, if_id,
594 DDR_TIMING_REG, txpdll << 4,
595 0x1f << 4));
596 CHECK_STATUS(ddr3_tip_if_write
597 (dev_num, access_type, if_id,
598 DDR_TIMING_REG, 0x28 << 9, 0x3f << 9));
599 CHECK_STATUS(ddr3_tip_if_write
600 (dev_num, access_type, if_id,
601 DDR_TIMING_REG, 0xa << 21, 0xff << 21));
602
603 /* move the block to ddr3_tip_set_timing - end */
604 /* AUTO_ZQC_TIMING */
605 CHECK_STATUS(ddr3_tip_if_write
606 (dev_num, access_type, if_id,
607 TIMING_REG, (AUTO_ZQC_TIMING | (2 << 20)),
608 0x3fffff));
609 CHECK_STATUS(ddr3_tip_if_read
610 (dev_num, access_type, if_id,
611 DRAM_PHY_CONFIGURATION, data_read, 0x30));
612 data_value =
613 (data_read[if_id] == 0) ? (1 << 11) : 0;
614 CHECK_STATUS(ddr3_tip_if_write
615 (dev_num, access_type, if_id,
616 DUNIT_CONTROL_HIGH_REG, data_value,
617 (1 << 11)));
618
619 /* Set Active control for ODT write transactions */
620 CHECK_STATUS(ddr3_tip_if_write
621 (dev_num, ACCESS_TYPE_MULTICAST,
622 PARAM_NOT_CARE, 0x1494, g_odt_config,
623 MASK_ALL_BITS));
624 }
625 } else {
626#ifdef STATIC_ALGO_SUPPORT
627 CHECK_STATUS(ddr3_tip_static_init_controller(dev_num));
628#if defined(CONFIG_ARMADA_38X) || defined(CONFIG_ARMADA_39X)
629 CHECK_STATUS(ddr3_tip_static_phy_init_controller(dev_num));
630#endif
631#endif /* STATIC_ALGO_SUPPORT */
632 }
633
634 for (if_id = 0; if_id <= MAX_INTERFACE_NUM - 1; if_id++) {
635 VALIDATE_ACTIVE(tm->if_act_mask, if_id);
636 CHECK_STATUS(ddr3_tip_rank_control(dev_num, if_id));
637
638 if (init_cntr_prm->do_mrs_phy) {
639 CHECK_STATUS(ddr3_tip_pad_inv(dev_num, if_id));
640 }
641
642 /* Pad calibration control - disable */
643 CHECK_STATUS(ddr3_tip_if_write
644 (dev_num, access_type, if_id,
645 CALIB_MACHINE_CTRL_REG, 0x0, 0x1));
646 CHECK_STATUS(ddr3_tip_if_write
647 (dev_num, access_type, if_id,
648 CALIB_MACHINE_CTRL_REG,
649 calibration_update_control << 3, 0x3 << 3));
650 }
651
652 CHECK_STATUS(ddr3_tip_enable_init_sequence(dev_num));
653
654 if (delay_enable != 0) {
655 adll_tap = MEGA / (freq_val[freq] * 64);
656 ddr3_tip_cmd_addr_init_delay(dev_num, adll_tap);
657 }
658
659 return MV_OK;
660}
661
662/*
663 * Load Topology map
664 */
665int hws_ddr3_tip_load_topology_map(u32 dev_num, struct hws_topology_map *tm)
666{
667 enum hws_speed_bin speed_bin_index;
668 enum hws_ddr_freq freq = DDR_FREQ_LIMIT;
669 u32 if_id;
670
671 freq_val[DDR_FREQ_LOW_FREQ] = dfs_low_freq;
672 tm = ddr3_get_topology_map();
673 CHECK_STATUS(ddr3_tip_get_first_active_if
674 ((u8)dev_num, tm->if_act_mask,
675 &first_active_if));
676 DEBUG_TRAINING_IP(DEBUG_LEVEL_TRACE,
677 ("board IF_Mask=0x%x num_of_bus_per_interface=0x%x\n",
678 tm->if_act_mask,
679 tm->num_of_bus_per_interface));
680
681 /*
682 * if CL, CWL values are missing in topology map, then fill them
683 * according to speedbin tables
684 */
685 for (if_id = 0; if_id <= MAX_INTERFACE_NUM - 1; if_id++) {
686 VALIDATE_ACTIVE(tm->if_act_mask, if_id);
687 speed_bin_index =
688 tm->interface_params[if_id].speed_bin_index;
689 /* TBD memory frequency of interface 0 only is used ! */
690 freq = tm->interface_params[first_active_if].memory_freq;
691
692 DEBUG_TRAINING_IP(DEBUG_LEVEL_TRACE,
693 ("speed_bin_index =%d freq=%d cl=%d cwl=%d\n",
694 speed_bin_index, freq_val[freq],
695 tm->interface_params[if_id].
696 cas_l,
697 tm->interface_params[if_id].
698 cas_wl));
699
700 if (tm->interface_params[if_id].cas_l == 0) {
701 tm->interface_params[if_id].cas_l =
702 cas_latency_table[speed_bin_index].cl_val[freq];
703 }
704
705 if (tm->interface_params[if_id].cas_wl == 0) {
706 tm->interface_params[if_id].cas_wl =
707 cas_write_latency_table[speed_bin_index].cl_val[freq];
708 }
709 }
710
711 return MV_OK;
712}
713
714/*
715 * RANK Control Flow
716 */
717static int ddr3_tip_rank_control(u32 dev_num, u32 if_id)
718{
719 u32 data_value = 0, bus_cnt;
720 struct hws_topology_map *tm = ddr3_get_topology_map();
721
722 for (bus_cnt = 1; bus_cnt < GET_TOPOLOGY_NUM_OF_BUSES(); bus_cnt++) {
723 VALIDATE_ACTIVE(tm->bus_act_mask, bus_cnt);
724 if ((tm->interface_params[if_id].
725 as_bus_params[0].cs_bitmask !=
726 tm->interface_params[if_id].
727 as_bus_params[bus_cnt].cs_bitmask) ||
728 (tm->interface_params[if_id].
729 as_bus_params[0].mirror_enable_bitmask !=
730 tm->interface_params[if_id].
731 as_bus_params[bus_cnt].mirror_enable_bitmask))
732 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
733 ("WARNING:Wrong configuration for pup #%d CS mask and CS mirroring for all pups should be the same\n",
734 bus_cnt));
735 }
736
737 data_value |= tm->interface_params[if_id].
738 as_bus_params[0].cs_bitmask;
739 data_value |= tm->interface_params[if_id].
740 as_bus_params[0].mirror_enable_bitmask << 4;
741
742 CHECK_STATUS(ddr3_tip_if_write
743 (dev_num, ACCESS_TYPE_UNICAST, if_id, RANK_CTRL_REG,
744 data_value, 0xff));
745
746 return MV_OK;
747}
748
749/*
750 * PAD Inverse Flow
751 */
752static int ddr3_tip_pad_inv(u32 dev_num, u32 if_id)
753{
754 u32 bus_cnt, data_value, ck_swap_pup_ctrl;
755 struct hws_topology_map *tm = ddr3_get_topology_map();
756
757 for (bus_cnt = 0; bus_cnt < GET_TOPOLOGY_NUM_OF_BUSES(); bus_cnt++) {
758 VALIDATE_ACTIVE(tm->bus_act_mask, bus_cnt);
759 if (tm->interface_params[if_id].
760 as_bus_params[bus_cnt].is_dqs_swap == 1) {
761 /* dqs swap */
762 ddr3_tip_bus_read_modify_write(dev_num, ACCESS_TYPE_UNICAST,
763 if_id, bus_cnt,
764 DDR_PHY_DATA,
765 PHY_CONTROL_PHY_REG, 0xc0,
766 0xc0);
767 }
768
769 if (tm->interface_params[if_id].
770 as_bus_params[bus_cnt].is_ck_swap == 1) {
771 if (bus_cnt <= 1)
772 data_value = 0x5 << 2;
773 else
774 data_value = 0xa << 2;
775
776 /* mask equals data */
777 /* ck swap pup is only control pup #0 ! */
778 ck_swap_pup_ctrl = 0;
779 ddr3_tip_bus_read_modify_write(dev_num, ACCESS_TYPE_UNICAST,
780 if_id, ck_swap_pup_ctrl,
781 DDR_PHY_CONTROL,
782 PHY_CONTROL_PHY_REG,
783 data_value, data_value);
784 }
785 }
786
787 return MV_OK;
788}
789
790/*
791 * Run Training Flow
792 */
793int hws_ddr3_tip_run_alg(u32 dev_num, enum hws_algo_type algo_type)
794{
795 int ret = MV_OK, ret_tune = MV_OK;
796
797#ifdef ODT_TEST_SUPPORT
798 if (finger_test == 1)
799 return odt_test(dev_num, algo_type);
800#endif
801
802 if (algo_type == ALGO_TYPE_DYNAMIC) {
803 ret = ddr3_tip_ddr3_auto_tune(dev_num);
804 } else {
805#ifdef STATIC_ALGO_SUPPORT
806 {
807 enum hws_ddr_freq freq;
808 freq = init_freq;
809
810 /* add to mask */
811 if (is_adll_calib_before_init != 0) {
812 printf("with adll calib before init\n");
813 adll_calibration(dev_num, ACCESS_TYPE_MULTICAST,
814 0, freq);
815 }
816 /*
817 * Frequency per interface is not relevant,
818 * only interface 0
819 */
820 ret = ddr3_tip_run_static_alg(dev_num,
821 freq);
822 }
823#endif
824 }
825
826 if (ret != MV_OK) {
827 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
828 ("Run_alg: tuning failed %d\n", ret_tune));
829 }
830
831 return ret;
832}
833
834#ifdef ODT_TEST_SUPPORT
835/*
836 * ODT Test
837 */
838static int odt_test(u32 dev_num, enum hws_algo_type algo_type)
839{
840 int ret = MV_OK, ret_tune = MV_OK;
841 int pfinger_val = 0, nfinger_val;
842
843 for (pfinger_val = p_finger_start; pfinger_val <= p_finger_end;
844 pfinger_val += p_finger_step) {
845 for (nfinger_val = n_finger_start; nfinger_val <= n_finger_end;
846 nfinger_val += n_finger_step) {
847 if (finger_test != 0) {
848 DEBUG_TRAINING_IP(DEBUG_LEVEL_INFO,
849 ("pfinger_val %d nfinger_val %d\n",
850 pfinger_val, nfinger_val));
851 p_finger = pfinger_val;
852 n_finger = nfinger_val;
853 }
854
855 if (algo_type == ALGO_TYPE_DYNAMIC) {
856 ret = ddr3_tip_ddr3_auto_tune(dev_num);
857 } else {
858 /*
859 * Frequency per interface is not relevant,
860 * only interface 0
861 */
862 ret = ddr3_tip_run_static_alg(dev_num,
863 init_freq);
864 }
865 }
866 }
867
868 if (ret_tune != MV_OK) {
869 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
870 ("Run_alg: tuning failed %d\n", ret_tune));
871 ret = (ret == MV_OK) ? ret_tune : ret;
872 }
873
874 return ret;
875}
876#endif
877
878/*
879 * Select Controller
880 */
881int hws_ddr3_tip_select_ddr_controller(u32 dev_num, int enable)
882{
883 if (config_func_info[dev_num].tip_dunit_mux_select_func != NULL) {
884 return config_func_info[dev_num].
885 tip_dunit_mux_select_func((u8)dev_num, enable);
886 }
887
888 return MV_FAIL;
889}
890
891/*
892 * Dunit Register Write
893 */
894int ddr3_tip_if_write(u32 dev_num, enum hws_access_type interface_access,
895 u32 if_id, u32 reg_addr, u32 data_value, u32 mask)
896{
897 if (config_func_info[dev_num].tip_dunit_write_func != NULL) {
898 return config_func_info[dev_num].
899 tip_dunit_write_func((u8)dev_num, interface_access,
900 if_id, reg_addr,
901 data_value, mask);
902 }
903
904 return MV_FAIL;
905}
906
907/*
908 * Dunit Register Read
909 */
910int ddr3_tip_if_read(u32 dev_num, enum hws_access_type interface_access,
911 u32 if_id, u32 reg_addr, u32 *data, u32 mask)
912{
913 if (config_func_info[dev_num].tip_dunit_read_func != NULL) {
914 return config_func_info[dev_num].
915 tip_dunit_read_func((u8)dev_num, interface_access,
916 if_id, reg_addr,
917 data, mask);
918 }
919
920 return MV_FAIL;
921}
922
923/*
924 * Dunit Register Polling
925 */
926int ddr3_tip_if_polling(u32 dev_num, enum hws_access_type access_type,
927 u32 if_id, u32 exp_value, u32 mask, u32 offset,
928 u32 poll_tries)
929{
930 u32 poll_cnt = 0, interface_num = 0, start_if, end_if;
931 u32 read_data[MAX_INTERFACE_NUM];
932 int ret;
933 int is_fail = 0, is_if_fail;
934 struct hws_topology_map *tm = ddr3_get_topology_map();
935
936 if (access_type == ACCESS_TYPE_MULTICAST) {
937 start_if = 0;
938 end_if = MAX_INTERFACE_NUM - 1;
939 } else {
940 start_if = if_id;
941 end_if = if_id;
942 }
943
944 for (interface_num = start_if; interface_num <= end_if; interface_num++) {
945 /* polling bit 3 for n times */
946 VALIDATE_ACTIVE(tm->if_act_mask, interface_num);
947
948 is_if_fail = 0;
949 for (poll_cnt = 0; poll_cnt < poll_tries; poll_cnt++) {
950 ret =
951 ddr3_tip_if_read(dev_num, ACCESS_TYPE_UNICAST,
952 interface_num, offset, read_data,
953 mask);
954 if (ret != MV_OK)
955 return ret;
956
957 if (read_data[interface_num] == exp_value)
958 break;
959 }
960
961 if (poll_cnt >= poll_tries) {
962 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
963 ("max poll IF #%d\n", interface_num));
964 is_fail = 1;
965 is_if_fail = 1;
966 }
967
968 training_result[training_stage][interface_num] =
969 (is_if_fail == 1) ? TEST_FAILED : TEST_SUCCESS;
970 }
971
972 return (is_fail == 0) ? MV_OK : MV_FAIL;
973}
974
975/*
976 * Bus read access
977 */
978int ddr3_tip_bus_read(u32 dev_num, u32 if_id,
979 enum hws_access_type phy_access, u32 phy_id,
980 enum hws_ddr_phy phy_type, u32 reg_addr, u32 *data)
981{
982 u32 bus_index = 0;
983 u32 data_read[MAX_INTERFACE_NUM];
984 struct hws_topology_map *tm = ddr3_get_topology_map();
985
986 if (phy_access == ACCESS_TYPE_MULTICAST) {
987 for (bus_index = 0; bus_index < GET_TOPOLOGY_NUM_OF_BUSES();
988 bus_index++) {
989 VALIDATE_ACTIVE(tm->bus_act_mask, bus_index);
990 CHECK_STATUS(ddr3_tip_bus_access
991 (dev_num, ACCESS_TYPE_UNICAST,
992 if_id, ACCESS_TYPE_UNICAST,
993 bus_index, phy_type, reg_addr, 0,
994 OPERATION_READ));
995 CHECK_STATUS(ddr3_tip_if_read
996 (dev_num, ACCESS_TYPE_UNICAST, if_id,
997 PHY_REG_FILE_ACCESS, data_read,
998 MASK_ALL_BITS));
999 data[bus_index] = (data_read[if_id] & 0xffff);
1000 }
1001 } else {
1002 CHECK_STATUS(ddr3_tip_bus_access
1003 (dev_num, ACCESS_TYPE_UNICAST, if_id,
1004 phy_access, phy_id, phy_type, reg_addr, 0,
1005 OPERATION_READ));
1006 CHECK_STATUS(ddr3_tip_if_read
1007 (dev_num, ACCESS_TYPE_UNICAST, if_id,
1008 PHY_REG_FILE_ACCESS, data_read, MASK_ALL_BITS));
1009
1010 /*
1011 * only 16 lsb bit are valid in Phy (each register is different,
1012 * some can actually be less than 16 bits)
1013 */
1014 *data = (data_read[if_id] & 0xffff);
1015 }
1016
1017 return MV_OK;
1018}
1019
1020/*
1021 * Bus write access
1022 */
1023int ddr3_tip_bus_write(u32 dev_num, enum hws_access_type interface_access,
1024 u32 if_id, enum hws_access_type phy_access,
1025 u32 phy_id, enum hws_ddr_phy phy_type, u32 reg_addr,
1026 u32 data_value)
1027{
1028 CHECK_STATUS(ddr3_tip_bus_access
1029 (dev_num, interface_access, if_id, phy_access,
1030 phy_id, phy_type, reg_addr, data_value, OPERATION_WRITE));
1031
1032 return MV_OK;
1033}
1034
1035/*
1036 * Bus access routine (relevant for both read & write)
1037 */
1038static int ddr3_tip_bus_access(u32 dev_num, enum hws_access_type interface_access,
1039 u32 if_id, enum hws_access_type phy_access,
1040 u32 phy_id, enum hws_ddr_phy phy_type, u32 reg_addr,
1041 u32 data_value, enum hws_operation oper_type)
1042{
1043 u32 addr_low = 0x3f & reg_addr;
1044 u32 addr_hi = ((0xc0 & reg_addr) >> 6);
1045 u32 data_p1 =
1046 (oper_type << 30) + (addr_hi << 28) + (phy_access << 27) +
1047 (phy_type << 26) + (phy_id << 22) + (addr_low << 16) +
1048 (data_value & 0xffff);
1049 u32 data_p2 = data_p1 + (1 << 31);
1050 u32 start_if, end_if;
1051 struct hws_topology_map *tm = ddr3_get_topology_map();
1052
1053 CHECK_STATUS(ddr3_tip_if_write
1054 (dev_num, interface_access, if_id, PHY_REG_FILE_ACCESS,
1055 data_p1, MASK_ALL_BITS));
1056 CHECK_STATUS(ddr3_tip_if_write
1057 (dev_num, interface_access, if_id, PHY_REG_FILE_ACCESS,
1058 data_p2, MASK_ALL_BITS));
1059
1060 if (interface_access == ACCESS_TYPE_UNICAST) {
1061 start_if = if_id;
1062 end_if = if_id;
1063 } else {
1064 start_if = 0;
1065 end_if = MAX_INTERFACE_NUM - 1;
1066 }
1067
1068 /* polling for read/write execution done */
1069 for (if_id = start_if; if_id <= end_if; if_id++) {
1070 VALIDATE_ACTIVE(tm->if_act_mask, if_id);
1071 CHECK_STATUS(is_bus_access_done
1072 (dev_num, if_id, PHY_REG_FILE_ACCESS, 31));
1073 }
1074
1075 return MV_OK;
1076}
1077
1078/*
1079 * Check bus access done
1080 */
1081static int is_bus_access_done(u32 dev_num, u32 if_id, u32 dunit_reg_adrr,
1082 u32 bit)
1083{
1084 u32 rd_data = 1;
1085 u32 cnt = 0;
1086 u32 data_read[MAX_INTERFACE_NUM];
1087
1088 CHECK_STATUS(ddr3_tip_if_read
1089 (dev_num, ACCESS_TYPE_UNICAST, if_id, dunit_reg_adrr,
1090 data_read, MASK_ALL_BITS));
1091 rd_data = data_read[if_id];
1092 rd_data &= (1 << bit);
1093
1094 while (rd_data != 0) {
1095 if (cnt++ >= MAX_POLLING_ITERATIONS)
1096 break;
1097
1098 CHECK_STATUS(ddr3_tip_if_read
1099 (dev_num, ACCESS_TYPE_UNICAST, if_id,
1100 dunit_reg_adrr, data_read, MASK_ALL_BITS));
1101 rd_data = data_read[if_id];
1102 rd_data &= (1 << bit);
1103 }
1104
1105 if (cnt < MAX_POLLING_ITERATIONS)
1106 return MV_OK;
1107 else
1108 return MV_FAIL;
1109}
1110
1111/*
1112 * Phy read-modify-write
1113 */
1114int ddr3_tip_bus_read_modify_write(u32 dev_num, enum hws_access_type access_type,
1115 u32 interface_id, u32 phy_id,
1116 enum hws_ddr_phy phy_type, u32 reg_addr,
1117 u32 data_value, u32 reg_mask)
1118{
1119 u32 data_val = 0, if_id, start_if, end_if;
1120 struct hws_topology_map *tm = ddr3_get_topology_map();
1121
1122 if (access_type == ACCESS_TYPE_MULTICAST) {
1123 start_if = 0;
1124 end_if = MAX_INTERFACE_NUM - 1;
1125 } else {
1126 start_if = interface_id;
1127 end_if = interface_id;
1128 }
1129
1130 for (if_id = start_if; if_id <= end_if; if_id++) {
1131 VALIDATE_ACTIVE(tm->if_act_mask, if_id);
1132 CHECK_STATUS(ddr3_tip_bus_read
1133 (dev_num, if_id, ACCESS_TYPE_UNICAST, phy_id,
1134 phy_type, reg_addr, &data_val));
1135 data_value = (data_val & (~reg_mask)) | (data_value & reg_mask);
1136 CHECK_STATUS(ddr3_tip_bus_write
1137 (dev_num, ACCESS_TYPE_UNICAST, if_id,
1138 ACCESS_TYPE_UNICAST, phy_id, phy_type, reg_addr,
1139 data_value));
1140 }
1141
1142 return MV_OK;
1143}
1144
1145/*
1146 * ADLL Calibration
1147 */
1148int adll_calibration(u32 dev_num, enum hws_access_type access_type,
1149 u32 if_id, enum hws_ddr_freq frequency)
1150{
1151 struct hws_tip_freq_config_info freq_config_info;
1152 u32 bus_cnt = 0;
1153 struct hws_topology_map *tm = ddr3_get_topology_map();
1154
1155 /* Reset Diver_b assert -> de-assert */
1156 CHECK_STATUS(ddr3_tip_if_write
1157 (dev_num, access_type, if_id, SDRAM_CONFIGURATION_REG,
1158 0, 0x10000000));
1159 mdelay(10);
1160 CHECK_STATUS(ddr3_tip_if_write
1161 (dev_num, access_type, if_id, SDRAM_CONFIGURATION_REG,
1162 0x10000000, 0x10000000));
1163
1164 if (config_func_info[dev_num].tip_get_freq_config_info_func != NULL) {
1165 CHECK_STATUS(config_func_info[dev_num].
1166 tip_get_freq_config_info_func((u8)dev_num, frequency,
1167 &freq_config_info));
1168 } else {
1169 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
1170 ("tip_get_freq_config_info_func is NULL"));
1171 return MV_NOT_INITIALIZED;
1172 }
1173
1174 for (bus_cnt = 0; bus_cnt < GET_TOPOLOGY_NUM_OF_BUSES(); bus_cnt++) {
1175 VALIDATE_ACTIVE(tm->bus_act_mask, bus_cnt);
1176 CHECK_STATUS(ddr3_tip_bus_read_modify_write
1177 (dev_num, access_type, if_id, bus_cnt,
1178 DDR_PHY_DATA, BW_PHY_REG,
1179 freq_config_info.bw_per_freq << 8, 0x700));
1180 CHECK_STATUS(ddr3_tip_bus_read_modify_write
1181 (dev_num, access_type, if_id, bus_cnt,
1182 DDR_PHY_DATA, RATE_PHY_REG,
1183 freq_config_info.rate_per_freq, 0x7));
1184 }
1185
1186 /* DUnit to Phy drive post edge, ADLL reset assert de-assert */
1187 CHECK_STATUS(ddr3_tip_if_write
1188 (dev_num, access_type, if_id, DRAM_PHY_CONFIGURATION,
1189 0, (0x80000000 | 0x40000000)));
1190 mdelay(100 / (freq_val[frequency] / freq_val[DDR_FREQ_LOW_FREQ]));
1191 CHECK_STATUS(ddr3_tip_if_write
1192 (dev_num, access_type, if_id, DRAM_PHY_CONFIGURATION,
1193 (0x80000000 | 0x40000000), (0x80000000 | 0x40000000)));
1194
1195 /* polling for ADLL Done */
1196 if (ddr3_tip_if_polling(dev_num, access_type, if_id,
1197 0x3ff03ff, 0x3ff03ff, PHY_LOCK_STATUS_REG,
1198 MAX_POLLING_ITERATIONS) != MV_OK) {
1199 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
1200 ("Freq_set: DDR3 poll failed(1)"));
1201 }
1202
1203 /* pup data_pup reset assert-> deassert */
1204 CHECK_STATUS(ddr3_tip_if_write
1205 (dev_num, access_type, if_id, SDRAM_CONFIGURATION_REG,
1206 0, 0x60000000));
1207 mdelay(10);
1208 CHECK_STATUS(ddr3_tip_if_write
1209 (dev_num, access_type, if_id, SDRAM_CONFIGURATION_REG,
1210 0x60000000, 0x60000000));
1211
1212 return MV_OK;
1213}
1214
1215int ddr3_tip_freq_set(u32 dev_num, enum hws_access_type access_type,
1216 u32 if_id, enum hws_ddr_freq frequency)
1217{
1218 u32 cl_value = 0, cwl_value = 0, mem_mask = 0, val = 0,
1219 bus_cnt = 0, t_hclk = 0, t_wr = 0,
1220 refresh_interval_cnt = 0, cnt_id;
1221 u32 t_refi = 0, end_if, start_if;
1222 u32 bus_index = 0;
1223 int is_dll_off = 0;
1224 enum hws_speed_bin speed_bin_index = 0;
1225 struct hws_tip_freq_config_info freq_config_info;
1226 enum hws_result *flow_result = training_result[training_stage];
1227 u32 adll_tap = 0;
1228 u32 cs_mask[MAX_INTERFACE_NUM];
1229 struct hws_topology_map *tm = ddr3_get_topology_map();
1230
1231 DEBUG_TRAINING_IP(DEBUG_LEVEL_TRACE,
1232 ("dev %d access %d IF %d freq %d\n", dev_num,
1233 access_type, if_id, frequency));
1234
1235 if (frequency == DDR_FREQ_LOW_FREQ)
1236 is_dll_off = 1;
1237 if (access_type == ACCESS_TYPE_MULTICAST) {
1238 start_if = 0;
1239 end_if = MAX_INTERFACE_NUM - 1;
1240 } else {
1241 start_if = if_id;
1242 end_if = if_id;
1243 }
1244
1245 /* calculate interface cs mask - Oferb 4/11 */
1246 /* speed bin can be different for each interface */
1247 for (if_id = 0; if_id <= MAX_INTERFACE_NUM - 1; if_id++) {
1248 /* cs enable is active low */
1249 VALIDATE_ACTIVE(tm->if_act_mask, if_id);
1250 cs_mask[if_id] = CS_BIT_MASK;
1251 training_result[training_stage][if_id] = TEST_SUCCESS;
1252 ddr3_tip_calc_cs_mask(dev_num, if_id, effective_cs,
1253 &cs_mask[if_id]);
1254 }
1255
1256 /* speed bin can be different for each interface */
1257 /*
1258 * moti b - need to remove the loop for multicas access functions
1259 * and loop the unicast access functions
1260 */
1261 for (if_id = start_if; if_id <= end_if; if_id++) {
1262 if (IS_ACTIVE(tm->if_act_mask, if_id) == 0)
1263 continue;
1264
1265 flow_result[if_id] = TEST_SUCCESS;
1266 speed_bin_index =
1267 tm->interface_params[if_id].speed_bin_index;
1268 if (tm->interface_params[if_id].memory_freq ==
1269 frequency) {
1270 cl_value =
1271 tm->interface_params[if_id].cas_l;
1272 cwl_value =
1273 tm->interface_params[if_id].cas_wl;
1274 } else {
1275 cl_value =
1276 cas_latency_table[speed_bin_index].cl_val[frequency];
1277 cwl_value =
1278 cas_write_latency_table[speed_bin_index].
1279 cl_val[frequency];
1280 }
1281
1282 DEBUG_TRAINING_IP(DEBUG_LEVEL_TRACE,
1283 ("Freq_set dev 0x%x access 0x%x if 0x%x freq 0x%x speed %d:\n\t",
1284 dev_num, access_type, if_id,
1285 frequency, speed_bin_index));
1286
1287 for (cnt_id = 0; cnt_id < DDR_FREQ_LIMIT; cnt_id++) {
1288 DEBUG_TRAINING_IP(DEBUG_LEVEL_TRACE,
1289 ("%d ",
1290 cas_latency_table[speed_bin_index].
1291 cl_val[cnt_id]));
1292 }
1293
1294 DEBUG_TRAINING_IP(DEBUG_LEVEL_TRACE, ("\n"));
1295 mem_mask = 0;
1296 for (bus_index = 0; bus_index < GET_TOPOLOGY_NUM_OF_BUSES();
1297 bus_index++) {
1298 VALIDATE_ACTIVE(tm->bus_act_mask, bus_index);
1299 mem_mask |=
1300 tm->interface_params[if_id].
1301 as_bus_params[bus_index].mirror_enable_bitmask;
1302 }
1303
1304 if (mem_mask != 0) {
Robert P. J. Dayc5b1e5d2016-09-07 14:27:59 -04001305 /* motib redundant in KW28 */
Stefan Roese5ffceb82015-03-26 15:36:56 +01001306 CHECK_STATUS(ddr3_tip_if_write(dev_num, access_type,
1307 if_id,
1308 CS_ENABLE_REG, 0, 0x8));
1309 }
1310
1311 /* dll state after exiting SR */
1312 if (is_dll_off == 1) {
1313 CHECK_STATUS(ddr3_tip_if_write
1314 (dev_num, access_type, if_id,
1315 DFS_REG, 0x1, 0x1));
1316 } else {
1317 CHECK_STATUS(ddr3_tip_if_write
1318 (dev_num, access_type, if_id,
1319 DFS_REG, 0, 0x1));
1320 }
1321
1322 CHECK_STATUS(ddr3_tip_if_write
1323 (dev_num, access_type, if_id,
1324 DUNIT_MMASK_REG, 0, 0x1));
1325 /* DFS - block transactions */
1326 CHECK_STATUS(ddr3_tip_if_write
1327 (dev_num, access_type, if_id,
1328 DFS_REG, 0x2, 0x2));
1329
1330 /* disable ODT in case of dll off */
1331 if (is_dll_off == 1) {
1332 CHECK_STATUS(ddr3_tip_if_write
1333 (dev_num, access_type, if_id,
1334 0x1874, 0, 0x244));
1335 CHECK_STATUS(ddr3_tip_if_write
1336 (dev_num, access_type, if_id,
1337 0x1884, 0, 0x244));
1338 CHECK_STATUS(ddr3_tip_if_write
1339 (dev_num, access_type, if_id,
1340 0x1894, 0, 0x244));
1341 CHECK_STATUS(ddr3_tip_if_write
1342 (dev_num, access_type, if_id,
1343 0x18a4, 0, 0x244));
1344 }
1345
1346 /* DFS - Enter Self-Refresh */
1347 CHECK_STATUS(ddr3_tip_if_write
1348 (dev_num, access_type, if_id, DFS_REG, 0x4,
1349 0x4));
1350 /* polling on self refresh entry */
1351 if (ddr3_tip_if_polling(dev_num, ACCESS_TYPE_UNICAST,
1352 if_id, 0x8, 0x8, DFS_REG,
1353 MAX_POLLING_ITERATIONS) != MV_OK) {
1354 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
1355 ("Freq_set: DDR3 poll failed on SR entry\n"));
1356 }
1357
1358 /* PLL configuration */
1359 if (config_func_info[dev_num].tip_set_freq_divider_func != NULL) {
1360 config_func_info[dev_num].
1361 tip_set_freq_divider_func(dev_num, if_id,
1362 frequency);
1363 }
1364
1365 /* PLL configuration End */
1366
1367 /* adjust t_refi to new frequency */
1368 t_refi = (tm->interface_params[if_id].interface_temp ==
1369 HWS_TEMP_HIGH) ? TREFI_LOW : TREFI_HIGH;
1370 t_refi *= 1000; /*psec */
1371
1372 /* HCLK in[ps] */
1373 t_hclk = MEGA / (freq_val[frequency] / 2);
1374 refresh_interval_cnt = t_refi / t_hclk; /* no units */
1375 val = 0x4000 | refresh_interval_cnt;
1376 CHECK_STATUS(ddr3_tip_if_write
1377 (dev_num, access_type, if_id,
1378 SDRAM_CONFIGURATION_REG, val, 0x7fff));
1379
1380 /* DFS - CL/CWL/WR parameters after exiting SR */
1381 CHECK_STATUS(ddr3_tip_if_write
1382 (dev_num, access_type, if_id, DFS_REG,
1383 (cl_mask_table[cl_value] << 8), 0xf00));
1384 CHECK_STATUS(ddr3_tip_if_write
1385 (dev_num, access_type, if_id, DFS_REG,
1386 (cwl_mask_table[cwl_value] << 12), 0x7000));
1387 t_wr = speed_bin_table(speed_bin_index, SPEED_BIN_TWR);
1388 t_wr = (t_wr / 1000);
1389 CHECK_STATUS(ddr3_tip_if_write
1390 (dev_num, access_type, if_id, DFS_REG,
1391 (twr_mask_table[t_wr + 1] << 16), 0x70000));
1392
1393 /* Restore original RTT values if returning from DLL OFF mode */
1394 if (is_dll_off == 1) {
1395 CHECK_STATUS(ddr3_tip_if_write
1396 (dev_num, access_type, if_id, 0x1874,
1397 g_dic | g_rtt_nom, 0x266));
1398 CHECK_STATUS(ddr3_tip_if_write
1399 (dev_num, access_type, if_id, 0x1884,
1400 g_dic | g_rtt_nom, 0x266));
1401 CHECK_STATUS(ddr3_tip_if_write
1402 (dev_num, access_type, if_id, 0x1894,
1403 g_dic | g_rtt_nom, 0x266));
1404 CHECK_STATUS(ddr3_tip_if_write
1405 (dev_num, access_type, if_id, 0x18a4,
1406 g_dic | g_rtt_nom, 0x266));
1407 }
1408
1409 /* Reset Diver_b assert -> de-assert */
1410 CHECK_STATUS(ddr3_tip_if_write
1411 (dev_num, access_type, if_id,
1412 SDRAM_CONFIGURATION_REG, 0, 0x10000000));
1413 mdelay(10);
1414 CHECK_STATUS(ddr3_tip_if_write
1415 (dev_num, access_type, if_id,
1416 SDRAM_CONFIGURATION_REG, 0x10000000, 0x10000000));
1417
1418 /* Adll configuration function of process and Frequency */
1419 if (config_func_info[dev_num].tip_get_freq_config_info_func != NULL) {
1420 CHECK_STATUS(config_func_info[dev_num].
1421 tip_get_freq_config_info_func(dev_num, frequency,
1422 &freq_config_info));
1423 }
1424 /* TBD check milo5 using device ID ? */
1425 for (bus_cnt = 0; bus_cnt < GET_TOPOLOGY_NUM_OF_BUSES();
1426 bus_cnt++) {
1427 VALIDATE_ACTIVE(tm->bus_act_mask, bus_cnt);
1428 CHECK_STATUS(ddr3_tip_bus_read_modify_write
1429 (dev_num, ACCESS_TYPE_UNICAST,
1430 if_id, bus_cnt, DDR_PHY_DATA,
1431 0x92,
1432 freq_config_info.
1433 bw_per_freq << 8
1434 /*freq_mask[dev_num][frequency] << 8 */
1435 , 0x700));
1436 CHECK_STATUS(ddr3_tip_bus_read_modify_write
1437 (dev_num, ACCESS_TYPE_UNICAST, if_id,
1438 bus_cnt, DDR_PHY_DATA, 0x94,
1439 freq_config_info.rate_per_freq, 0x7));
1440 }
1441
1442 /* DUnit to Phy drive post edge, ADLL reset assert de-assert */
1443 CHECK_STATUS(ddr3_tip_if_write
1444 (dev_num, access_type, if_id,
1445 DRAM_PHY_CONFIGURATION, 0,
1446 (0x80000000 | 0x40000000)));
1447 mdelay(100 / (freq_val[frequency] / freq_val[DDR_FREQ_LOW_FREQ]));
1448 CHECK_STATUS(ddr3_tip_if_write
1449 (dev_num, access_type, if_id,
1450 DRAM_PHY_CONFIGURATION, (0x80000000 | 0x40000000),
1451 (0x80000000 | 0x40000000)));
1452
1453 /* polling for ADLL Done */
1454 if (ddr3_tip_if_polling
1455 (dev_num, ACCESS_TYPE_UNICAST, if_id, 0x3ff03ff,
1456 0x3ff03ff, PHY_LOCK_STATUS_REG,
1457 MAX_POLLING_ITERATIONS) != MV_OK) {
1458 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
1459 ("Freq_set: DDR3 poll failed(1)\n"));
1460 }
1461
1462 /* pup data_pup reset assert-> deassert */
1463 CHECK_STATUS(ddr3_tip_if_write
1464 (dev_num, access_type, if_id,
1465 SDRAM_CONFIGURATION_REG, 0, 0x60000000));
1466 mdelay(10);
1467 CHECK_STATUS(ddr3_tip_if_write
1468 (dev_num, access_type, if_id,
1469 SDRAM_CONFIGURATION_REG, 0x60000000, 0x60000000));
1470
1471 /* Set proper timing params before existing Self-Refresh */
1472 ddr3_tip_set_timing(dev_num, access_type, if_id, frequency);
1473 if (delay_enable != 0) {
1474 adll_tap = MEGA / (freq_val[frequency] * 64);
1475 ddr3_tip_cmd_addr_init_delay(dev_num, adll_tap);
1476 }
1477
1478 /* Exit SR */
1479 CHECK_STATUS(ddr3_tip_if_write
1480 (dev_num, access_type, if_id, DFS_REG, 0,
1481 0x4));
1482 if (ddr3_tip_if_polling
1483 (dev_num, ACCESS_TYPE_UNICAST, if_id, 0, 0x8, DFS_REG,
1484 MAX_POLLING_ITERATIONS) != MV_OK) {
1485 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
1486 ("Freq_set: DDR3 poll failed(2)"));
1487 }
1488
1489 /* Refresh Command */
1490 CHECK_STATUS(ddr3_tip_if_write
1491 (dev_num, access_type, if_id,
1492 SDRAM_OPERATION_REG, 0x2, 0xf1f));
1493 if (ddr3_tip_if_polling
1494 (dev_num, ACCESS_TYPE_UNICAST, if_id, 0, 0x1f,
1495 SDRAM_OPERATION_REG, MAX_POLLING_ITERATIONS) != MV_OK) {
1496 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
1497 ("Freq_set: DDR3 poll failed(3)"));
1498 }
1499
1500 /* Release DFS Block */
1501 CHECK_STATUS(ddr3_tip_if_write
1502 (dev_num, access_type, if_id, DFS_REG, 0,
1503 0x2));
1504 /* Controller to MBUS Retry - normal */
1505 CHECK_STATUS(ddr3_tip_if_write
1506 (dev_num, access_type, if_id, DUNIT_MMASK_REG,
1507 0x1, 0x1));
1508
1509 /* MRO: Burst Length 8, CL , Auto_precharge 0x16cc */
1510 val =
1511 ((cl_mask_table[cl_value] & 0x1) << 2) |
1512 ((cl_mask_table[cl_value] & 0xe) << 3);
1513 CHECK_STATUS(ddr3_tip_if_write
1514 (dev_num, access_type, if_id, MR0_REG,
1515 val, (0x7 << 4) | (1 << 2)));
1516 /* MR2: CWL = 10 , Auto Self-Refresh - disable */
1517 val = (cwl_mask_table[cwl_value] << 3);
1518 /*
1519 * nklein 24.10.13 - should not be here - leave value as set in
1520 * the init configuration val |= (1 << 9);
1521 * val |= ((tm->interface_params[if_id].
1522 * interface_temp == HWS_TEMP_HIGH) ? (1 << 7) : 0);
1523 */
1524 /* nklein 24.10.13 - see above comment */
1525 CHECK_STATUS(ddr3_tip_if_write(dev_num, access_type,
1526 if_id, MR2_REG,
1527 val, (0x7 << 3)));
1528
1529 /* ODT TIMING */
1530 val = ((cl_value - cwl_value + 1) << 4) |
1531 ((cl_value - cwl_value + 6) << 8) |
1532 ((cl_value - 1) << 12) | ((cl_value + 6) << 16);
1533 CHECK_STATUS(ddr3_tip_if_write(dev_num, access_type,
1534 if_id, ODT_TIMING_LOW,
1535 val, 0xffff0));
1536 val = 0x71 | ((cwl_value - 1) << 8) | ((cwl_value + 5) << 12);
1537 CHECK_STATUS(ddr3_tip_if_write(dev_num, access_type,
1538 if_id, ODT_TIMING_HI_REG,
1539 val, 0xffff));
1540
1541 /* ODT Active */
1542 CHECK_STATUS(ddr3_tip_if_write(dev_num, access_type,
1543 if_id,
1544 DUNIT_ODT_CONTROL_REG,
1545 0xf, 0xf));
1546
1547 /* re-write CL */
1548 val = ((cl_mask_table[cl_value] & 0x1) << 2) |
1549 ((cl_mask_table[cl_value] & 0xe) << 3);
1550 CHECK_STATUS(ddr3_tip_if_write(dev_num, ACCESS_TYPE_MULTICAST,
1551 0, MR0_REG, val,
1552 (0x7 << 4) | (1 << 2)));
1553
1554 /* re-write CWL */
1555 val = (cwl_mask_table[cwl_value] << 3);
1556 CHECK_STATUS(ddr3_tip_write_mrs_cmd(dev_num, cs_mask, MRS2_CMD,
1557 val, (0x7 << 3)));
1558 CHECK_STATUS(ddr3_tip_if_write(dev_num, ACCESS_TYPE_MULTICAST,
1559 0, MR2_REG, val, (0x7 << 3)));
1560
1561 if (mem_mask != 0) {
1562 CHECK_STATUS(ddr3_tip_if_write(dev_num, access_type,
1563 if_id,
1564 CS_ENABLE_REG,
1565 1 << 3, 0x8));
1566 }
1567 }
1568
1569 return MV_OK;
1570}
1571
1572/*
1573 * Set ODT values
1574 */
1575static int ddr3_tip_write_odt(u32 dev_num, enum hws_access_type access_type,
1576 u32 if_id, u32 cl_value, u32 cwl_value)
1577{
1578 /* ODT TIMING */
1579 u32 val = (cl_value - cwl_value + 6);
1580
1581 val = ((cl_value - cwl_value + 1) << 4) | ((val & 0xf) << 8) |
1582 (((cl_value - 1) & 0xf) << 12) |
1583 (((cl_value + 6) & 0xf) << 16) | (((val & 0x10) >> 4) << 21);
1584 val |= (((cl_value - 1) >> 4) << 22) | (((cl_value + 6) >> 4) << 23);
1585
1586 CHECK_STATUS(ddr3_tip_if_write(dev_num, access_type, if_id,
1587 ODT_TIMING_LOW, val, 0xffff0));
1588 val = 0x71 | ((cwl_value - 1) << 8) | ((cwl_value + 5) << 12);
1589 CHECK_STATUS(ddr3_tip_if_write(dev_num, access_type, if_id,
1590 ODT_TIMING_HI_REG, val, 0xffff));
1591 if (odt_additional == 1) {
1592 CHECK_STATUS(ddr3_tip_if_write(dev_num, access_type,
1593 if_id,
1594 SDRAM_ODT_CONTROL_HIGH_REG,
1595 0xf, 0xf));
1596 }
1597
1598 /* ODT Active */
1599 CHECK_STATUS(ddr3_tip_if_write(dev_num, access_type, if_id,
1600 DUNIT_ODT_CONTROL_REG, 0xf, 0xf));
1601
1602 return MV_OK;
1603}
1604
1605/*
1606 * Set Timing values for training
1607 */
1608static int ddr3_tip_set_timing(u32 dev_num, enum hws_access_type access_type,
1609 u32 if_id, enum hws_ddr_freq frequency)
1610{
1611 u32 t_ckclk = 0, t_ras = 0;
1612 u32 t_rcd = 0, t_rp = 0, t_wr = 0, t_wtr = 0, t_rrd = 0, t_rtp = 0,
1613 t_rfc = 0, t_mod = 0;
1614 u32 val = 0, page_size = 0;
1615 enum hws_speed_bin speed_bin_index;
1616 enum hws_mem_size memory_size = MEM_2G;
1617 struct hws_topology_map *tm = ddr3_get_topology_map();
1618
1619 speed_bin_index = tm->interface_params[if_id].speed_bin_index;
1620 memory_size = tm->interface_params[if_id].memory_size;
1621 page_size =
1622 (tm->interface_params[if_id].bus_width ==
1623 BUS_WIDTH_8) ? page_param[memory_size].
1624 page_size_8bit : page_param[memory_size].page_size_16bit;
1625 t_ckclk = (MEGA / freq_val[frequency]);
1626 t_rrd = (page_size == 1) ? speed_bin_table(speed_bin_index,
1627 SPEED_BIN_TRRD1K) :
1628 speed_bin_table(speed_bin_index, SPEED_BIN_TRRD2K);
1629 t_rrd = GET_MAX_VALUE(t_ckclk * 4, t_rrd);
1630 t_rtp = GET_MAX_VALUE(t_ckclk * 4, speed_bin_table(speed_bin_index,
1631 SPEED_BIN_TRTP));
1632 t_wtr = GET_MAX_VALUE(t_ckclk * 4, speed_bin_table(speed_bin_index,
1633 SPEED_BIN_TWTR));
1634 t_ras = TIME_2_CLOCK_CYCLES(speed_bin_table(speed_bin_index,
1635 SPEED_BIN_TRAS),
1636 t_ckclk);
1637 t_rcd = TIME_2_CLOCK_CYCLES(speed_bin_table(speed_bin_index,
1638 SPEED_BIN_TRCD),
1639 t_ckclk);
1640 t_rp = TIME_2_CLOCK_CYCLES(speed_bin_table(speed_bin_index,
1641 SPEED_BIN_TRP),
1642 t_ckclk);
1643 t_wr = TIME_2_CLOCK_CYCLES(speed_bin_table(speed_bin_index,
1644 SPEED_BIN_TWR),
1645 t_ckclk);
1646 t_wtr = TIME_2_CLOCK_CYCLES(t_wtr, t_ckclk);
1647 t_rrd = TIME_2_CLOCK_CYCLES(t_rrd, t_ckclk);
1648 t_rtp = TIME_2_CLOCK_CYCLES(t_rtp, t_ckclk);
1649 t_rfc = TIME_2_CLOCK_CYCLES(rfc_table[memory_size] * 1000, t_ckclk);
1650 t_mod = GET_MAX_VALUE(t_ckclk * 24, 15000);
1651 t_mod = TIME_2_CLOCK_CYCLES(t_mod, t_ckclk);
1652
1653 /* SDRAM Timing Low */
1654 val = (t_ras & 0xf) | (t_rcd << 4) | (t_rp << 8) | (t_wr << 12) |
1655 (t_wtr << 16) | (((t_ras & 0x30) >> 4) << 20) | (t_rrd << 24) |
1656 (t_rtp << 28);
1657 CHECK_STATUS(ddr3_tip_if_write(dev_num, access_type, if_id,
1658 SDRAM_TIMING_LOW_REG, val, 0xff3fffff));
1659
1660 /* SDRAM Timing High */
1661 CHECK_STATUS(ddr3_tip_if_write(dev_num, access_type, if_id,
1662 SDRAM_TIMING_HIGH_REG,
1663 t_rfc & 0x7f, 0x7f));
1664 CHECK_STATUS(ddr3_tip_if_write(dev_num, access_type, if_id,
1665 SDRAM_TIMING_HIGH_REG,
1666 0x180, 0x180));
1667 CHECK_STATUS(ddr3_tip_if_write(dev_num, access_type, if_id,
1668 SDRAM_TIMING_HIGH_REG,
1669 0x600, 0x600));
1670 CHECK_STATUS(ddr3_tip_if_write(dev_num, access_type, if_id,
1671 SDRAM_TIMING_HIGH_REG,
1672 0x1800, 0xf800));
1673 CHECK_STATUS(ddr3_tip_if_write(dev_num, access_type, if_id,
1674 SDRAM_TIMING_HIGH_REG,
1675 ((t_rfc & 0x380) >> 7) << 16, 0x70000));
1676 CHECK_STATUS(ddr3_tip_if_write(dev_num, access_type, if_id,
1677 SDRAM_TIMING_HIGH_REG, 0,
1678 0x380000));
1679 CHECK_STATUS(ddr3_tip_if_write(dev_num, access_type, if_id,
1680 SDRAM_TIMING_HIGH_REG,
1681 (t_mod & 0xf) << 25, 0x1e00000));
1682 CHECK_STATUS(ddr3_tip_if_write(dev_num, access_type, if_id,
1683 SDRAM_TIMING_HIGH_REG,
1684 (t_mod >> 4) << 30, 0xc0000000));
1685 CHECK_STATUS(ddr3_tip_if_write(dev_num, access_type, if_id,
1686 SDRAM_TIMING_HIGH_REG,
1687 0x16000000, 0x1e000000));
1688 CHECK_STATUS(ddr3_tip_if_write(dev_num, access_type, if_id,
1689 SDRAM_TIMING_HIGH_REG,
1690 0x40000000, 0xc0000000));
1691
1692 return MV_OK;
1693}
1694
1695/*
1696 * Mode Read
1697 */
1698int hws_ddr3_tip_mode_read(u32 dev_num, struct mode_info *mode_info)
1699{
1700 u32 ret;
1701
1702 ret = ddr3_tip_if_read(dev_num, ACCESS_TYPE_MULTICAST, PARAM_NOT_CARE,
1703 MR0_REG, mode_info->reg_mr0, MASK_ALL_BITS);
1704 if (ret != MV_OK)
1705 return ret;
1706
1707 ret = ddr3_tip_if_read(dev_num, ACCESS_TYPE_MULTICAST, PARAM_NOT_CARE,
1708 MR1_REG, mode_info->reg_mr1, MASK_ALL_BITS);
1709 if (ret != MV_OK)
1710 return ret;
1711
1712 ret = ddr3_tip_if_read(dev_num, ACCESS_TYPE_MULTICAST, PARAM_NOT_CARE,
1713 MR2_REG, mode_info->reg_mr2, MASK_ALL_BITS);
1714 if (ret != MV_OK)
1715 return ret;
1716
1717 ret = ddr3_tip_if_read(dev_num, ACCESS_TYPE_MULTICAST, PARAM_NOT_CARE,
1718 MR3_REG, mode_info->reg_mr2, MASK_ALL_BITS);
1719 if (ret != MV_OK)
1720 return ret;
1721
1722 ret = ddr3_tip_if_read(dev_num, ACCESS_TYPE_MULTICAST, PARAM_NOT_CARE,
1723 READ_DATA_SAMPLE_DELAY, mode_info->read_data_sample,
1724 MASK_ALL_BITS);
1725 if (ret != MV_OK)
1726 return ret;
1727
1728 ret = ddr3_tip_if_read(dev_num, ACCESS_TYPE_MULTICAST, PARAM_NOT_CARE,
1729 READ_DATA_READY_DELAY, mode_info->read_data_ready,
1730 MASK_ALL_BITS);
1731 if (ret != MV_OK)
1732 return ret;
1733
1734 return MV_OK;
1735}
1736
1737/*
1738 * Get first active IF
1739 */
1740int ddr3_tip_get_first_active_if(u8 dev_num, u32 interface_mask,
1741 u32 *interface_id)
1742{
1743 u32 if_id;
1744 struct hws_topology_map *tm = ddr3_get_topology_map();
1745
1746 for (if_id = 0; if_id <= MAX_INTERFACE_NUM - 1; if_id++) {
1747 VALIDATE_ACTIVE(tm->if_act_mask, if_id);
1748 if (interface_mask & (1 << if_id)) {
1749 *interface_id = if_id;
1750 break;
1751 }
1752 }
1753
1754 return MV_OK;
1755}
1756
1757/*
1758 * Write CS Result
1759 */
1760int ddr3_tip_write_cs_result(u32 dev_num, u32 offset)
1761{
1762 u32 if_id, bus_num, cs_bitmask, data_val, cs_num;
1763 struct hws_topology_map *tm = ddr3_get_topology_map();
1764
1765 for (if_id = 0; if_id <= MAX_INTERFACE_NUM - 1; if_id++) {
1766 VALIDATE_ACTIVE(tm->if_act_mask, if_id);
1767 for (bus_num = 0; bus_num < tm->num_of_bus_per_interface;
1768 bus_num++) {
1769 VALIDATE_ACTIVE(tm->bus_act_mask, bus_num);
1770 cs_bitmask =
1771 tm->interface_params[if_id].
1772 as_bus_params[bus_num].cs_bitmask;
1773 if (cs_bitmask != effective_cs) {
1774 cs_num = GET_CS_FROM_MASK(cs_bitmask);
1775 ddr3_tip_bus_read(dev_num, if_id,
1776 ACCESS_TYPE_UNICAST, bus_num,
1777 DDR_PHY_DATA,
1778 offset +
1779 CS_REG_VALUE(effective_cs),
1780 &data_val);
1781 ddr3_tip_bus_write(dev_num,
1782 ACCESS_TYPE_UNICAST,
1783 if_id,
1784 ACCESS_TYPE_UNICAST,
1785 bus_num, DDR_PHY_DATA,
1786 offset +
1787 CS_REG_VALUE(cs_num),
1788 data_val);
1789 }
1790 }
1791 }
1792
1793 return MV_OK;
1794}
1795
1796/*
1797 * Write MRS
1798 */
1799int ddr3_tip_write_mrs_cmd(u32 dev_num, u32 *cs_mask_arr, u32 cmd,
1800 u32 data, u32 mask)
1801{
1802 u32 if_id, reg;
1803 struct hws_topology_map *tm = ddr3_get_topology_map();
1804
1805 reg = (cmd == MRS1_CMD) ? MR1_REG : MR2_REG;
1806 CHECK_STATUS(ddr3_tip_if_write(dev_num, ACCESS_TYPE_MULTICAST,
1807 PARAM_NOT_CARE, reg, data, mask));
1808 for (if_id = 0; if_id <= MAX_INTERFACE_NUM - 1; if_id++) {
1809 VALIDATE_ACTIVE(tm->if_act_mask, if_id);
1810 CHECK_STATUS(ddr3_tip_if_write
1811 (dev_num, ACCESS_TYPE_UNICAST, if_id,
1812 SDRAM_OPERATION_REG,
1813 (cs_mask_arr[if_id] << 8) | cmd, 0xf1f));
1814 }
1815
1816 for (if_id = 0; if_id <= MAX_INTERFACE_NUM - 1; if_id++) {
1817 VALIDATE_ACTIVE(tm->if_act_mask, if_id);
1818 if (ddr3_tip_if_polling(dev_num, ACCESS_TYPE_UNICAST, if_id, 0,
1819 0x1f, SDRAM_OPERATION_REG,
1820 MAX_POLLING_ITERATIONS) != MV_OK) {
1821 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
1822 ("write_mrs_cmd: Poll cmd fail"));
1823 }
1824 }
1825
1826 return MV_OK;
1827}
1828
1829/*
1830 * Reset XSB Read FIFO
1831 */
1832int ddr3_tip_reset_fifo_ptr(u32 dev_num)
1833{
1834 u32 if_id = 0;
1835
1836 /* Configure PHY reset value to 0 in order to "clean" the FIFO */
1837 CHECK_STATUS(ddr3_tip_if_write(dev_num, ACCESS_TYPE_MULTICAST,
1838 if_id, 0x15c8, 0, 0xff000000));
1839 /*
1840 * Move PHY to RL mode (only in RL mode the PHY overrides FIFO values
1841 * during FIFO reset)
1842 */
1843 CHECK_STATUS(ddr3_tip_if_write(dev_num, ACCESS_TYPE_MULTICAST,
1844 if_id, TRAINING_SW_2_REG,
1845 0x1, 0x9));
1846 /* In order that above configuration will influence the PHY */
1847 CHECK_STATUS(ddr3_tip_if_write(dev_num, ACCESS_TYPE_MULTICAST,
1848 if_id, 0x15b0,
1849 0x80000000, 0x80000000));
1850 /* Reset read fifo assertion */
1851 CHECK_STATUS(ddr3_tip_if_write(dev_num, ACCESS_TYPE_MULTICAST,
1852 if_id, 0x1400, 0, 0x40000000));
1853 /* Reset read fifo deassertion */
1854 CHECK_STATUS(ddr3_tip_if_write(dev_num, ACCESS_TYPE_MULTICAST,
1855 if_id, 0x1400,
1856 0x40000000, 0x40000000));
1857 /* Move PHY back to functional mode */
1858 CHECK_STATUS(ddr3_tip_if_write(dev_num, ACCESS_TYPE_MULTICAST,
1859 if_id, TRAINING_SW_2_REG,
1860 0x8, 0x9));
1861 /* Stop training machine */
1862 CHECK_STATUS(ddr3_tip_if_write(dev_num, ACCESS_TYPE_MULTICAST,
1863 if_id, 0x15b4, 0x10000, 0x10000));
1864
1865 return MV_OK;
1866}
1867
1868/*
1869 * Reset Phy registers
1870 */
1871int ddr3_tip_ddr3_reset_phy_regs(u32 dev_num)
1872{
1873 u32 if_id, phy_id, cs;
1874 struct hws_topology_map *tm = ddr3_get_topology_map();
1875
1876 for (if_id = 0; if_id <= MAX_INTERFACE_NUM - 1; if_id++) {
1877 VALIDATE_ACTIVE(tm->if_act_mask, if_id);
1878 for (phy_id = 0; phy_id < tm->num_of_bus_per_interface;
1879 phy_id++) {
1880 VALIDATE_ACTIVE(tm->bus_act_mask, phy_id);
1881 CHECK_STATUS(ddr3_tip_bus_write
1882 (dev_num, ACCESS_TYPE_UNICAST,
1883 if_id, ACCESS_TYPE_UNICAST,
1884 phy_id, DDR_PHY_DATA,
1885 WL_PHY_REG +
1886 CS_REG_VALUE(effective_cs),
1887 phy_reg0_val));
1888 CHECK_STATUS(ddr3_tip_bus_write
1889 (dev_num, ACCESS_TYPE_UNICAST, if_id,
1890 ACCESS_TYPE_UNICAST, phy_id, DDR_PHY_DATA,
1891 RL_PHY_REG + CS_REG_VALUE(effective_cs),
1892 phy_reg2_val));
1893 CHECK_STATUS(ddr3_tip_bus_write
1894 (dev_num, ACCESS_TYPE_UNICAST, if_id,
1895 ACCESS_TYPE_UNICAST, phy_id, DDR_PHY_DATA,
1896 READ_CENTRALIZATION_PHY_REG +
1897 CS_REG_VALUE(effective_cs), phy_reg3_val));
1898 CHECK_STATUS(ddr3_tip_bus_write
1899 (dev_num, ACCESS_TYPE_UNICAST, if_id,
1900 ACCESS_TYPE_UNICAST, phy_id, DDR_PHY_DATA,
1901 WRITE_CENTRALIZATION_PHY_REG +
1902 CS_REG_VALUE(effective_cs), phy_reg3_val));
1903 }
1904 }
1905
1906 /* Set Receiver Calibration value */
1907 for (cs = 0; cs < MAX_CS_NUM; cs++) {
1908 /* PHY register 0xdb bits[5:0] - configure to 63 */
1909 CHECK_STATUS(ddr3_tip_bus_write
1910 (dev_num, ACCESS_TYPE_MULTICAST, PARAM_NOT_CARE,
1911 ACCESS_TYPE_MULTICAST, PARAM_NOT_CARE,
1912 DDR_PHY_DATA, CSN_IOB_VREF_REG(cs), 63));
1913 }
1914
1915 return MV_OK;
1916}
1917
1918/*
1919 * Restore Dunit registers
1920 */
1921int ddr3_tip_restore_dunit_regs(u32 dev_num)
1922{
1923 u32 index_cnt;
1924
1925 CHECK_STATUS(ddr3_tip_if_write(dev_num, ACCESS_TYPE_MULTICAST,
1926 PARAM_NOT_CARE, CALIB_MACHINE_CTRL_REG,
1927 0x1, 0x1));
1928 CHECK_STATUS(ddr3_tip_if_write(dev_num, ACCESS_TYPE_MULTICAST,
1929 PARAM_NOT_CARE, CALIB_MACHINE_CTRL_REG,
1930 calibration_update_control << 3,
1931 0x3 << 3));
1932 CHECK_STATUS(ddr3_tip_if_write(dev_num, ACCESS_TYPE_MULTICAST,
1933 PARAM_NOT_CARE,
1934 ODPG_WRITE_READ_MODE_ENABLE_REG,
1935 0xffff, MASK_ALL_BITS));
1936
1937 for (index_cnt = 0; index_cnt < ARRAY_SIZE(odpg_default_value);
1938 index_cnt++) {
1939 CHECK_STATUS(ddr3_tip_if_write
1940 (dev_num, ACCESS_TYPE_MULTICAST, PARAM_NOT_CARE,
1941 odpg_default_value[index_cnt].reg_addr,
1942 odpg_default_value[index_cnt].reg_data,
1943 odpg_default_value[index_cnt].reg_mask));
1944 }
1945
1946 return MV_OK;
1947}
1948
1949/*
1950 * Auto tune main flow
1951 */
1952static int ddr3_tip_ddr3_training_main_flow(u32 dev_num)
1953{
1954 enum hws_ddr_freq freq = init_freq;
1955 struct init_cntr_param init_cntr_prm;
1956 int ret = MV_OK;
1957 u32 if_id;
1958 u32 max_cs = hws_ddr3_tip_max_cs_get();
1959 struct hws_topology_map *tm = ddr3_get_topology_map();
1960
1961#ifndef EXCLUDE_SWITCH_DEBUG
1962 if (debug_training == DEBUG_LEVEL_TRACE) {
1963 CHECK_STATUS(print_device_info((u8)dev_num));
1964 }
1965#endif
1966
1967 for (effective_cs = 0; effective_cs < max_cs; effective_cs++) {
1968 CHECK_STATUS(ddr3_tip_ddr3_reset_phy_regs(dev_num));
1969 }
1970 /* Set to 0 after each loop to avoid illegal value may be used */
1971 effective_cs = 0;
1972
1973 freq = init_freq;
1974 if (is_pll_before_init != 0) {
1975 for (if_id = 0; if_id < MAX_INTERFACE_NUM; if_id++) {
1976 VALIDATE_ACTIVE(tm->if_act_mask, if_id);
1977 config_func_info[dev_num].tip_set_freq_divider_func(
1978 (u8)dev_num, if_id, freq);
1979 }
1980 }
1981
1982 if (is_adll_calib_before_init != 0) {
1983 DEBUG_TRAINING_IP(DEBUG_LEVEL_INFO,
1984 ("with adll calib before init\n"));
1985 adll_calibration(dev_num, ACCESS_TYPE_MULTICAST, 0, freq);
1986 }
1987
1988 if (is_reg_dump != 0) {
1989 DEBUG_TRAINING_IP(DEBUG_LEVEL_INFO,
1990 ("Dump before init controller\n"));
1991 ddr3_tip_reg_dump(dev_num);
1992 }
1993
1994 if (mask_tune_func & INIT_CONTROLLER_MASK_BIT) {
1995 training_stage = INIT_CONTROLLER;
1996 DEBUG_TRAINING_IP(DEBUG_LEVEL_INFO,
1997 ("INIT_CONTROLLER_MASK_BIT\n"));
1998 init_cntr_prm.do_mrs_phy = 1;
1999 init_cntr_prm.is_ctrl64_bit = 0;
2000 init_cntr_prm.init_phy = 1;
2001 init_cntr_prm.msys_init = 0;
2002 ret = hws_ddr3_tip_init_controller(dev_num, &init_cntr_prm);
2003 if (is_reg_dump != 0)
2004 ddr3_tip_reg_dump(dev_num);
2005 if (ret != MV_OK) {
2006 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
2007 ("hws_ddr3_tip_init_controller failure\n"));
2008 if (debug_mode == 0)
2009 return MV_FAIL;
2010 }
2011 }
2012
2013#ifdef STATIC_ALGO_SUPPORT
2014 if (mask_tune_func & STATIC_LEVELING_MASK_BIT) {
2015 training_stage = STATIC_LEVELING;
2016 DEBUG_TRAINING_IP(DEBUG_LEVEL_INFO,
2017 ("STATIC_LEVELING_MASK_BIT\n"));
2018 ret = ddr3_tip_run_static_alg(dev_num, freq);
2019 if (is_reg_dump != 0)
2020 ddr3_tip_reg_dump(dev_num);
2021 if (ret != MV_OK) {
2022 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
2023 ("ddr3_tip_run_static_alg failure\n"));
2024 if (debug_mode == 0)
2025 return MV_FAIL;
2026 }
2027 }
2028#endif
2029
2030 if (mask_tune_func & SET_LOW_FREQ_MASK_BIT) {
2031 training_stage = SET_LOW_FREQ;
2032 DEBUG_TRAINING_IP(DEBUG_LEVEL_INFO,
2033 ("SET_LOW_FREQ_MASK_BIT %d\n",
2034 freq_val[low_freq]));
2035 ret = ddr3_tip_freq_set(dev_num, ACCESS_TYPE_MULTICAST,
2036 PARAM_NOT_CARE, low_freq);
2037 if (is_reg_dump != 0)
2038 ddr3_tip_reg_dump(dev_num);
2039 if (ret != MV_OK) {
2040 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
2041 ("ddr3_tip_freq_set failure\n"));
2042 if (debug_mode == 0)
2043 return MV_FAIL;
2044 }
2045 }
2046
2047 for (effective_cs = 0; effective_cs < max_cs; effective_cs++) {
2048 if (mask_tune_func & LOAD_PATTERN_MASK_BIT) {
2049 training_stage = LOAD_PATTERN;
2050 DEBUG_TRAINING_IP(DEBUG_LEVEL_INFO,
2051 ("LOAD_PATTERN_MASK_BIT #%d\n",
2052 effective_cs));
2053 ret = ddr3_tip_load_all_pattern_to_mem(dev_num);
2054 if (is_reg_dump != 0)
2055 ddr3_tip_reg_dump(dev_num);
2056 if (ret != MV_OK) {
2057 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
2058 ("ddr3_tip_load_all_pattern_to_mem failure CS #%d\n",
2059 effective_cs));
2060 if (debug_mode == 0)
2061 return MV_FAIL;
2062 }
2063 }
2064 }
2065 /* Set to 0 after each loop to avoid illegal value may be used */
2066 effective_cs = 0;
2067
2068 if (mask_tune_func & SET_MEDIUM_FREQ_MASK_BIT) {
2069 training_stage = SET_MEDIUM_FREQ;
2070 DEBUG_TRAINING_IP(DEBUG_LEVEL_INFO,
2071 ("SET_MEDIUM_FREQ_MASK_BIT %d\n",
2072 freq_val[medium_freq]));
2073 ret =
2074 ddr3_tip_freq_set(dev_num, ACCESS_TYPE_MULTICAST,
2075 PARAM_NOT_CARE, medium_freq);
2076 if (is_reg_dump != 0)
2077 ddr3_tip_reg_dump(dev_num);
2078 if (ret != MV_OK) {
2079 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
2080 ("ddr3_tip_freq_set failure\n"));
2081 if (debug_mode == 0)
2082 return MV_FAIL;
2083 }
2084 }
2085
2086 if (mask_tune_func & WRITE_LEVELING_MASK_BIT) {
2087 training_stage = WRITE_LEVELING;
2088 DEBUG_TRAINING_IP(DEBUG_LEVEL_INFO,
2089 ("WRITE_LEVELING_MASK_BIT\n"));
2090 if ((rl_mid_freq_wa == 0) || (freq_val[medium_freq] == 533)) {
2091 ret = ddr3_tip_dynamic_write_leveling(dev_num);
2092 } else {
2093 /* Use old WL */
2094 ret = ddr3_tip_legacy_dynamic_write_leveling(dev_num);
2095 }
2096
2097 if (is_reg_dump != 0)
2098 ddr3_tip_reg_dump(dev_num);
2099 if (ret != MV_OK) {
2100 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
2101 ("ddr3_tip_dynamic_write_leveling failure\n"));
2102 if (debug_mode == 0)
2103 return MV_FAIL;
2104 }
2105 }
2106
2107 for (effective_cs = 0; effective_cs < max_cs; effective_cs++) {
2108 if (mask_tune_func & LOAD_PATTERN_2_MASK_BIT) {
2109 training_stage = LOAD_PATTERN_2;
2110 DEBUG_TRAINING_IP(DEBUG_LEVEL_INFO,
2111 ("LOAD_PATTERN_2_MASK_BIT CS #%d\n",
2112 effective_cs));
2113 ret = ddr3_tip_load_all_pattern_to_mem(dev_num);
2114 if (is_reg_dump != 0)
2115 ddr3_tip_reg_dump(dev_num);
2116 if (ret != MV_OK) {
2117 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
2118 ("ddr3_tip_load_all_pattern_to_mem failure CS #%d\n",
2119 effective_cs));
2120 if (debug_mode == 0)
2121 return MV_FAIL;
2122 }
2123 }
2124 }
2125 /* Set to 0 after each loop to avoid illegal value may be used */
2126 effective_cs = 0;
2127
2128 if (mask_tune_func & READ_LEVELING_MASK_BIT) {
2129 training_stage = READ_LEVELING;
2130 DEBUG_TRAINING_IP(DEBUG_LEVEL_INFO,
2131 ("READ_LEVELING_MASK_BIT\n"));
2132 if ((rl_mid_freq_wa == 0) || (freq_val[medium_freq] == 533)) {
2133 ret = ddr3_tip_dynamic_read_leveling(dev_num, medium_freq);
2134 } else {
2135 /* Use old RL */
2136 ret = ddr3_tip_legacy_dynamic_read_leveling(dev_num);
2137 }
2138
2139 if (is_reg_dump != 0)
2140 ddr3_tip_reg_dump(dev_num);
2141 if (ret != MV_OK) {
2142 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
2143 ("ddr3_tip_dynamic_read_leveling failure\n"));
2144 if (debug_mode == 0)
2145 return MV_FAIL;
2146 }
2147 }
2148
2149 if (mask_tune_func & WRITE_LEVELING_SUPP_MASK_BIT) {
2150 training_stage = WRITE_LEVELING_SUPP;
2151 DEBUG_TRAINING_IP(DEBUG_LEVEL_INFO,
2152 ("WRITE_LEVELING_SUPP_MASK_BIT\n"));
2153 ret = ddr3_tip_dynamic_write_leveling_supp(dev_num);
2154 if (is_reg_dump != 0)
2155 ddr3_tip_reg_dump(dev_num);
2156 if (ret != MV_OK) {
2157 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
2158 ("ddr3_tip_dynamic_write_leveling_supp failure\n"));
2159 if (debug_mode == 0)
2160 return MV_FAIL;
2161 }
2162 }
2163
2164 for (effective_cs = 0; effective_cs < max_cs; effective_cs++) {
2165 if (mask_tune_func & PBS_RX_MASK_BIT) {
2166 training_stage = PBS_RX;
2167 DEBUG_TRAINING_IP(DEBUG_LEVEL_INFO,
2168 ("PBS_RX_MASK_BIT CS #%d\n",
2169 effective_cs));
2170 ret = ddr3_tip_pbs_rx(dev_num);
2171 if (is_reg_dump != 0)
2172 ddr3_tip_reg_dump(dev_num);
2173 if (ret != MV_OK) {
2174 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
2175 ("ddr3_tip_pbs_rx failure CS #%d\n",
2176 effective_cs));
2177 if (debug_mode == 0)
2178 return MV_FAIL;
2179 }
2180 }
2181 }
2182
2183 for (effective_cs = 0; effective_cs < max_cs; effective_cs++) {
2184 if (mask_tune_func & PBS_TX_MASK_BIT) {
2185 training_stage = PBS_TX;
2186 DEBUG_TRAINING_IP(DEBUG_LEVEL_INFO,
2187 ("PBS_TX_MASK_BIT CS #%d\n",
2188 effective_cs));
2189 ret = ddr3_tip_pbs_tx(dev_num);
2190 if (is_reg_dump != 0)
2191 ddr3_tip_reg_dump(dev_num);
2192 if (ret != MV_OK) {
2193 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
2194 ("ddr3_tip_pbs_tx failure CS #%d\n",
2195 effective_cs));
2196 if (debug_mode == 0)
2197 return MV_FAIL;
2198 }
2199 }
2200 }
2201 /* Set to 0 after each loop to avoid illegal value may be used */
2202 effective_cs = 0;
2203
2204 if (mask_tune_func & SET_TARGET_FREQ_MASK_BIT) {
2205 training_stage = SET_TARGET_FREQ;
2206 DEBUG_TRAINING_IP(DEBUG_LEVEL_INFO,
2207 ("SET_TARGET_FREQ_MASK_BIT %d\n",
2208 freq_val[tm->
2209 interface_params[first_active_if].
2210 memory_freq]));
2211 ret = ddr3_tip_freq_set(dev_num, ACCESS_TYPE_MULTICAST,
2212 PARAM_NOT_CARE,
2213 tm->interface_params[first_active_if].
2214 memory_freq);
2215 if (is_reg_dump != 0)
2216 ddr3_tip_reg_dump(dev_num);
2217 if (ret != MV_OK) {
2218 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
2219 ("ddr3_tip_freq_set failure\n"));
2220 if (debug_mode == 0)
2221 return MV_FAIL;
2222 }
2223 }
2224
2225 if (mask_tune_func & WRITE_LEVELING_TF_MASK_BIT) {
2226 training_stage = WRITE_LEVELING_TF;
2227 DEBUG_TRAINING_IP(DEBUG_LEVEL_INFO,
2228 ("WRITE_LEVELING_TF_MASK_BIT\n"));
2229 ret = ddr3_tip_dynamic_write_leveling(dev_num);
2230 if (is_reg_dump != 0)
2231 ddr3_tip_reg_dump(dev_num);
2232 if (ret != MV_OK) {
2233 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
2234 ("ddr3_tip_dynamic_write_leveling TF failure\n"));
2235 if (debug_mode == 0)
2236 return MV_FAIL;
2237 }
2238 }
2239
2240 if (mask_tune_func & LOAD_PATTERN_HIGH_MASK_BIT) {
2241 training_stage = LOAD_PATTERN_HIGH;
2242 DEBUG_TRAINING_IP(DEBUG_LEVEL_INFO, ("LOAD_PATTERN_HIGH\n"));
2243 ret = ddr3_tip_load_all_pattern_to_mem(dev_num);
2244 if (is_reg_dump != 0)
2245 ddr3_tip_reg_dump(dev_num);
2246 if (ret != MV_OK) {
2247 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
2248 ("ddr3_tip_load_all_pattern_to_mem failure\n"));
2249 if (debug_mode == 0)
2250 return MV_FAIL;
2251 }
2252 }
2253
2254 if (mask_tune_func & READ_LEVELING_TF_MASK_BIT) {
2255 training_stage = READ_LEVELING_TF;
2256 DEBUG_TRAINING_IP(DEBUG_LEVEL_INFO,
2257 ("READ_LEVELING_TF_MASK_BIT\n"));
2258 ret = ddr3_tip_dynamic_read_leveling(dev_num, tm->
2259 interface_params[first_active_if].
2260 memory_freq);
2261 if (is_reg_dump != 0)
2262 ddr3_tip_reg_dump(dev_num);
2263 if (ret != MV_OK) {
2264 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
2265 ("ddr3_tip_dynamic_read_leveling TF failure\n"));
2266 if (debug_mode == 0)
2267 return MV_FAIL;
2268 }
2269 }
2270
2271 if (mask_tune_func & DM_PBS_TX_MASK_BIT) {
2272 DEBUG_TRAINING_IP(DEBUG_LEVEL_INFO, ("DM_PBS_TX_MASK_BIT\n"));
2273 }
2274
2275 for (effective_cs = 0; effective_cs < max_cs; effective_cs++) {
2276 if (mask_tune_func & VREF_CALIBRATION_MASK_BIT) {
2277 training_stage = VREF_CALIBRATION;
2278 DEBUG_TRAINING_IP(DEBUG_LEVEL_INFO, ("VREF\n"));
2279 ret = ddr3_tip_vref(dev_num);
2280 if (is_reg_dump != 0) {
2281 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
2282 ("VREF Dump\n"));
2283 ddr3_tip_reg_dump(dev_num);
2284 }
2285 if (ret != MV_OK) {
2286 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
2287 ("ddr3_tip_vref failure\n"));
2288 if (debug_mode == 0)
2289 return MV_FAIL;
2290 }
2291 }
2292 }
2293 /* Set to 0 after each loop to avoid illegal value may be used */
2294 effective_cs = 0;
2295
2296 for (effective_cs = 0; effective_cs < max_cs; effective_cs++) {
2297 if (mask_tune_func & CENTRALIZATION_RX_MASK_BIT) {
2298 training_stage = CENTRALIZATION_RX;
2299 DEBUG_TRAINING_IP(DEBUG_LEVEL_INFO,
2300 ("CENTRALIZATION_RX_MASK_BIT CS #%d\n",
2301 effective_cs));
2302 ret = ddr3_tip_centralization_rx(dev_num);
2303 if (is_reg_dump != 0)
2304 ddr3_tip_reg_dump(dev_num);
2305 if (ret != MV_OK) {
2306 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
2307 ("ddr3_tip_centralization_rx failure CS #%d\n",
2308 effective_cs));
2309 if (debug_mode == 0)
2310 return MV_FAIL;
2311 }
2312 }
2313 }
2314 /* Set to 0 after each loop to avoid illegal value may be used */
2315 effective_cs = 0;
2316
2317 for (effective_cs = 0; effective_cs < max_cs; effective_cs++) {
2318 if (mask_tune_func & WRITE_LEVELING_SUPP_TF_MASK_BIT) {
2319 training_stage = WRITE_LEVELING_SUPP_TF;
2320 DEBUG_TRAINING_IP(DEBUG_LEVEL_INFO,
2321 ("WRITE_LEVELING_SUPP_TF_MASK_BIT CS #%d\n",
2322 effective_cs));
2323 ret = ddr3_tip_dynamic_write_leveling_supp(dev_num);
2324 if (is_reg_dump != 0)
2325 ddr3_tip_reg_dump(dev_num);
2326 if (ret != MV_OK) {
2327 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
2328 ("ddr3_tip_dynamic_write_leveling_supp TF failure CS #%d\n",
2329 effective_cs));
2330 if (debug_mode == 0)
2331 return MV_FAIL;
2332 }
2333 }
2334 }
2335 /* Set to 0 after each loop to avoid illegal value may be used */
2336 effective_cs = 0;
2337
2338 for (effective_cs = 0; effective_cs < max_cs; effective_cs++) {
2339 if (mask_tune_func & CENTRALIZATION_TX_MASK_BIT) {
2340 training_stage = CENTRALIZATION_TX;
2341 DEBUG_TRAINING_IP(DEBUG_LEVEL_INFO,
2342 ("CENTRALIZATION_TX_MASK_BIT CS #%d\n",
2343 effective_cs));
2344 ret = ddr3_tip_centralization_tx(dev_num);
2345 if (is_reg_dump != 0)
2346 ddr3_tip_reg_dump(dev_num);
2347 if (ret != MV_OK) {
2348 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
2349 ("ddr3_tip_centralization_tx failure CS #%d\n",
2350 effective_cs));
2351 if (debug_mode == 0)
2352 return MV_FAIL;
2353 }
2354 }
2355 }
2356 /* Set to 0 after each loop to avoid illegal value may be used */
2357 effective_cs = 0;
2358
2359 DEBUG_TRAINING_IP(DEBUG_LEVEL_INFO, ("restore registers to default\n"));
2360 /* restore register values */
2361 CHECK_STATUS(ddr3_tip_restore_dunit_regs(dev_num));
2362
2363 if (is_reg_dump != 0)
2364 ddr3_tip_reg_dump(dev_num);
2365
2366 return MV_OK;
2367}
2368
2369/*
2370 * DDR3 Dynamic training flow
2371 */
2372static int ddr3_tip_ddr3_auto_tune(u32 dev_num)
2373{
2374 u32 if_id, stage, ret;
2375 int is_if_fail = 0, is_auto_tune_fail = 0;
2376
2377 training_stage = INIT_CONTROLLER;
2378
2379 for (if_id = 0; if_id <= MAX_INTERFACE_NUM - 1; if_id++) {
2380 for (stage = 0; stage < MAX_STAGE_LIMIT; stage++)
2381 training_result[stage][if_id] = NO_TEST_DONE;
2382 }
2383
2384 ret = ddr3_tip_ddr3_training_main_flow(dev_num);
2385
2386 /* activate XSB test */
2387 if (xsb_validate_type != 0) {
2388 run_xsb_test(dev_num, xsb_validation_base_address, 1, 1,
2389 0x1024);
2390 }
2391
2392 if (is_reg_dump != 0)
2393 ddr3_tip_reg_dump(dev_num);
2394
2395 /* print log */
2396 CHECK_STATUS(ddr3_tip_print_log(dev_num, window_mem_addr));
2397
2398 if (ret != MV_OK) {
2399 CHECK_STATUS(ddr3_tip_print_stability_log(dev_num));
2400 }
2401
2402 for (if_id = 0; if_id <= MAX_INTERFACE_NUM - 1; if_id++) {
2403 is_if_fail = 0;
2404 for (stage = 0; stage < MAX_STAGE_LIMIT; stage++) {
2405 if (training_result[stage][if_id] == TEST_FAILED)
2406 is_if_fail = 1;
2407 }
2408 if (is_if_fail == 1) {
2409 is_auto_tune_fail = 1;
2410 DEBUG_TRAINING_IP(DEBUG_LEVEL_INFO,
2411 ("Auto Tune failed for IF %d\n",
2412 if_id));
2413 }
2414 }
2415
2416 if ((ret == MV_FAIL) || (is_auto_tune_fail == 1))
2417 return MV_FAIL;
2418 else
2419 return MV_OK;
2420}
2421
2422/*
2423 * Enable init sequence
2424 */
2425int ddr3_tip_enable_init_sequence(u32 dev_num)
2426{
2427 int is_fail = 0;
2428 u32 if_id = 0, mem_mask = 0, bus_index = 0;
2429 struct hws_topology_map *tm = ddr3_get_topology_map();
2430
2431 /* Enable init sequence */
2432 CHECK_STATUS(ddr3_tip_if_write(dev_num, ACCESS_TYPE_MULTICAST, 0,
2433 SDRAM_INIT_CONTROL_REG, 0x1, 0x1));
2434
2435 for (if_id = 0; if_id <= MAX_INTERFACE_NUM - 1; if_id++) {
2436 VALIDATE_ACTIVE(tm->if_act_mask, if_id);
2437
2438 if (ddr3_tip_if_polling
2439 (dev_num, ACCESS_TYPE_UNICAST, if_id, 0, 0x1,
2440 SDRAM_INIT_CONTROL_REG,
2441 MAX_POLLING_ITERATIONS) != MV_OK) {
2442 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
2443 ("polling failed IF %d\n",
2444 if_id));
2445 is_fail = 1;
2446 continue;
2447 }
2448
2449 mem_mask = 0;
2450 for (bus_index = 0; bus_index < GET_TOPOLOGY_NUM_OF_BUSES();
2451 bus_index++) {
2452 VALIDATE_ACTIVE(tm->bus_act_mask, bus_index);
2453 mem_mask |=
2454 tm->interface_params[if_id].
2455 as_bus_params[bus_index].mirror_enable_bitmask;
2456 }
2457
2458 if (mem_mask != 0) {
2459 /* Disable Multi CS */
2460 CHECK_STATUS(ddr3_tip_if_write
2461 (dev_num, ACCESS_TYPE_MULTICAST,
2462 if_id, CS_ENABLE_REG, 1 << 3,
2463 1 << 3));
2464 }
2465 }
2466
2467 return (is_fail == 0) ? MV_OK : MV_FAIL;
2468}
2469
2470int ddr3_tip_register_dq_table(u32 dev_num, u32 *table)
2471{
2472 dq_map_table = table;
2473
2474 return MV_OK;
2475}
2476
2477/*
2478 * Check if pup search is locked
2479 */
2480int ddr3_tip_is_pup_lock(u32 *pup_buf, enum hws_training_result read_mode)
2481{
2482 u32 bit_start = 0, bit_end = 0, bit_id;
2483
2484 if (read_mode == RESULT_PER_BIT) {
2485 bit_start = 0;
2486 bit_end = BUS_WIDTH_IN_BITS - 1;
2487 } else {
2488 bit_start = 0;
2489 bit_end = 0;
2490 }
2491
2492 for (bit_id = bit_start; bit_id <= bit_end; bit_id++) {
2493 if (GET_LOCK_RESULT(pup_buf[bit_id]) == 0)
2494 return 0;
2495 }
2496
2497 return 1;
2498}
2499
2500/*
2501 * Get minimum buffer value
2502 */
2503u8 ddr3_tip_get_buf_min(u8 *buf_ptr)
2504{
2505 u8 min_val = 0xff;
2506 u8 cnt = 0;
2507
2508 for (cnt = 0; cnt < BUS_WIDTH_IN_BITS; cnt++) {
2509 if (buf_ptr[cnt] < min_val)
2510 min_val = buf_ptr[cnt];
2511 }
2512
2513 return min_val;
2514}
2515
2516/*
2517 * Get maximum buffer value
2518 */
2519u8 ddr3_tip_get_buf_max(u8 *buf_ptr)
2520{
2521 u8 max_val = 0;
2522 u8 cnt = 0;
2523
2524 for (cnt = 0; cnt < BUS_WIDTH_IN_BITS; cnt++) {
2525 if (buf_ptr[cnt] > max_val)
2526 max_val = buf_ptr[cnt];
2527 }
2528
2529 return max_val;
2530}
2531
2532/*
2533 * The following functions return memory parameters:
2534 * bus and device width, device size
2535 */
2536
2537u32 hws_ddr3_get_bus_width(void)
2538{
2539 struct hws_topology_map *tm = ddr3_get_topology_map();
2540
2541 return (DDR3_IS_16BIT_DRAM_MODE(tm->bus_act_mask) ==
2542 1) ? 16 : 32;
2543}
2544
2545u32 hws_ddr3_get_device_width(u32 if_id)
2546{
2547 struct hws_topology_map *tm = ddr3_get_topology_map();
2548
2549 return (tm->interface_params[if_id].bus_width ==
2550 BUS_WIDTH_8) ? 8 : 16;
2551}
2552
2553u32 hws_ddr3_get_device_size(u32 if_id)
2554{
2555 struct hws_topology_map *tm = ddr3_get_topology_map();
2556
2557 if (tm->interface_params[if_id].memory_size >=
2558 MEM_SIZE_LAST) {
2559 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
2560 ("Error: Wrong device size of Cs: %d",
2561 tm->interface_params[if_id].memory_size));
2562 return 0;
2563 } else {
2564 return 1 << tm->interface_params[if_id].memory_size;
2565 }
2566}
2567
2568int hws_ddr3_calc_mem_cs_size(u32 if_id, u32 cs, u32 *cs_size)
2569{
2570 u32 cs_mem_size, dev_size;
2571
2572 dev_size = hws_ddr3_get_device_size(if_id);
2573 if (dev_size != 0) {
2574 cs_mem_size = ((hws_ddr3_get_bus_width() /
2575 hws_ddr3_get_device_width(if_id)) * dev_size);
2576
2577 /* the calculated result in Gbytex16 to avoid float using */
2578
2579 if (cs_mem_size == 2) {
2580 *cs_size = _128M;
2581 } else if (cs_mem_size == 4) {
2582 *cs_size = _256M;
2583 } else if (cs_mem_size == 8) {
2584 *cs_size = _512M;
2585 } else if (cs_mem_size == 16) {
2586 *cs_size = _1G;
2587 } else if (cs_mem_size == 32) {
2588 *cs_size = _2G;
2589 } else {
2590 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
2591 ("Error: Wrong Memory size of Cs: %d", cs));
2592 return MV_FAIL;
2593 }
2594 return MV_OK;
2595 } else {
2596 return MV_FAIL;
2597 }
2598}
2599
2600int hws_ddr3_cs_base_adr_calc(u32 if_id, u32 cs, u32 *cs_base_addr)
2601{
2602 u32 cs_mem_size = 0;
2603#ifdef DEVICE_MAX_DRAM_ADDRESS_SIZE
2604 u32 physical_mem_size;
2605 u32 max_mem_size = DEVICE_MAX_DRAM_ADDRESS_SIZE;
2606#endif
2607
2608 if (hws_ddr3_calc_mem_cs_size(if_id, cs, &cs_mem_size) != MV_OK)
2609 return MV_FAIL;
2610
2611#ifdef DEVICE_MAX_DRAM_ADDRESS_SIZE
2612 struct hws_topology_map *tm = ddr3_get_topology_map();
2613 /*
2614 * if number of address pins doesn't allow to use max mem size that
2615 * is defined in topology mem size is defined by
2616 * DEVICE_MAX_DRAM_ADDRESS_SIZE
2617 */
2618 physical_mem_size =
2619 mv_hwsmem_size[tm->interface_params[0].memory_size];
2620
2621 if (hws_ddr3_get_device_width(cs) == 16) {
2622 /*
2623 * 16bit mem device can be twice more - no need in less
2624 * significant pin
2625 */
2626 max_mem_size = DEVICE_MAX_DRAM_ADDRESS_SIZE * 2;
2627 }
2628
2629 if (physical_mem_size > max_mem_size) {
2630 cs_mem_size = max_mem_size *
2631 (hws_ddr3_get_bus_width() /
2632 hws_ddr3_get_device_width(if_id));
2633 DEBUG_TRAINING_IP(DEBUG_LEVEL_ERROR,
2634 ("Updated Physical Mem size is from 0x%x to %x\n",
2635 physical_mem_size,
2636 DEVICE_MAX_DRAM_ADDRESS_SIZE));
2637 }
2638#endif
2639
2640 /* calculate CS base addr */
2641 *cs_base_addr = ((cs_mem_size) * cs) & 0xffff0000;
2642
2643 return MV_OK;
2644}