1 /*
2  * Copyright 2021 NXP
3  *
4  * SPDX-License-Identifier: BSD-3-Clause
5  *
6  */
7 
8 #include <errno.h>
9 #include <stdbool.h>
10 #include <stdint.h>
11 #include <stdio.h>
12 #include <stdlib.h>
13 
14 #include <common/debug.h>
15 #include <ddr.h>
16 
cal_ddr_sdram_clk_cntl(struct ddr_cfg_regs * regs,const struct memctl_opt * popts)17 static void cal_ddr_sdram_clk_cntl(struct ddr_cfg_regs *regs,
18 					 const struct memctl_opt *popts)
19 {
20 	const unsigned int clk_adj = popts->clk_adj;
21 	const unsigned int ss_en = 0U;
22 
23 	regs->clk_cntl = ((ss_en & U(0x1)) << 31U)		|
24 				  ((clk_adj & U(0x1F)) << 22U);
25 	debug("clk_cntl = 0x%x\n", regs->clk_cntl);
26 }
27 
cal_ddr_cdr(struct ddr_cfg_regs * regs,const struct memctl_opt * popts)28 static void cal_ddr_cdr(struct ddr_cfg_regs *regs,
29 			const struct memctl_opt *popts)
30 {
31 	regs->cdr[0] = popts->ddr_cdr1;
32 	regs->cdr[1] = popts->ddr_cdr2;
33 	debug("cdr[0] = 0x%x\n", regs->cdr[0]);
34 	debug("cdr[1] = 0x%x\n", regs->cdr[1]);
35 }
36 
cal_ddr_wrlvl_cntl(struct ddr_cfg_regs * regs,const struct memctl_opt * popts)37 static void cal_ddr_wrlvl_cntl(struct ddr_cfg_regs *regs,
38 				const struct memctl_opt *popts)
39 {
40 	const unsigned int wrlvl_en = 1U;	/* enabled */
41 	const unsigned int wrlvl_mrd = U(0x6);	/* > 40nCK */
42 	const unsigned int wrlvl_odten = U(0x7);	/* 128 */
43 	const unsigned int wrlvl_dqsen = U(0x5);	/* > 25nCK */
44 	const unsigned int wrlvl_wlr = U(0x6);	/* > tWLO + 6 */
45 	const unsigned int wrlvl_smpl = popts->wrlvl_override ?
46 					popts->wrlvl_sample : U(0xf);
47 	const unsigned int wrlvl_start = popts->wrlvl_start;
48 
49 	regs->wrlvl_cntl[0] = ((wrlvl_en & U(0x1)) << 31U)	|
50 				  ((wrlvl_mrd & U(0x7)) << 24U)	|
51 				  ((wrlvl_odten & U(0x7)) << 20U)	|
52 				  ((wrlvl_dqsen & U(0x7)) << 16U)	|
53 				  ((wrlvl_smpl & U(0xf)) << 12U)	|
54 				  ((wrlvl_wlr & U(0x7)) << 8U)	|
55 				  ((wrlvl_start & U(0x1F)) << 0U);
56 	regs->wrlvl_cntl[1] = popts->wrlvl_ctl_2;
57 	regs->wrlvl_cntl[2] = popts->wrlvl_ctl_3;
58 	debug("wrlvl_cntl[0] = 0x%x\n", regs->wrlvl_cntl[0]);
59 	debug("wrlvl_cntl[1] = 0x%x\n", regs->wrlvl_cntl[1]);
60 	debug("wrlvl_cntl[2] = 0x%x\n", regs->wrlvl_cntl[2]);
61 
62 }
63 
cal_ddr_dbg(struct ddr_cfg_regs * regs,const struct memctl_opt * popts)64 static void cal_ddr_dbg(struct ddr_cfg_regs *regs,
65 			const struct memctl_opt *popts)
66 {
67 	if (popts->cswl_override != 0) {
68 		regs->debug[18] = popts->cswl_override;
69 	}
70 
71 #ifdef CONFIG_SYS_FSL_DDR_EMU
72 	/* disable DDR training for emulator */
73 	regs->debug[2] = U(0x00000400);
74 	regs->debug[4] = U(0xff800800);
75 	regs->debug[5] = U(0x08000800);
76 	regs->debug[6] = U(0x08000800);
77 	regs->debug[7] = U(0x08000800);
78 	regs->debug[8] = U(0x08000800);
79 #endif
80 	if (popts->cpo_sample != 0U) {
81 		regs->debug[28] = popts->cpo_sample;
82 		debug("debug[28] = 0x%x\n", regs->debug[28]);
83 	}
84 }
85 
compute_ddr_phy(struct ddr_info * priv)86 int compute_ddr_phy(struct ddr_info *priv)
87 {
88 	const struct memctl_opt *popts = &priv->opt;
89 	struct ddr_cfg_regs *regs = &priv->ddr_reg;
90 
91 	cal_ddr_sdram_clk_cntl(regs, popts);
92 	cal_ddr_cdr(regs, popts);
93 	cal_ddr_wrlvl_cntl(regs, popts);
94 	cal_ddr_dbg(regs, popts);
95 
96 	return 0;
97 }
98