Tony Xie | f6118cc | 2016-01-15 17:17:32 +0800 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (c) 2016, ARM Limited and Contributors. All rights reserved. |
| 3 | * |
dp-arm | fa3cf0b | 2017-05-03 09:38:09 +0100 | [diff] [blame] | 4 | * SPDX-License-Identifier: BSD-3-Clause |
Tony Xie | f6118cc | 2016-01-15 17:17:32 +0800 | [diff] [blame] | 5 | */ |
| 6 | |
Antonio Nino Diaz | e0f9063 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 7 | #include <stdint.h> |
| 8 | #include <string.h> |
| 9 | |
Tony Xie | f6118cc | 2016-01-15 17:17:32 +0800 | [diff] [blame] | 10 | #include <platform_def.h> |
Antonio Nino Diaz | e0f9063 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 11 | |
| 12 | #include <common/debug.h> |
| 13 | #include <lib/mmio.h> |
| 14 | |
| 15 | #include <ddr_rk3368.h> |
Tony Xie | f6118cc | 2016-01-15 17:17:32 +0800 | [diff] [blame] | 16 | #include <pmu.h> |
| 17 | #include <rk3368_def.h> |
| 18 | #include <soc.h> |
Tony Xie | f6118cc | 2016-01-15 17:17:32 +0800 | [diff] [blame] | 19 | |
| 20 | /* GRF_SOC_STATUS0 */ |
| 21 | #define DPLL_LOCK (0x1 << 2) |
| 22 | |
| 23 | /* GRF_DDRC0_CON0 */ |
| 24 | #define GRF_DDR_16BIT_EN (((0x1 << 3) << 16) | (0x1 << 3)) |
| 25 | #define GRF_DDR_32BIT_EN (((0x1 << 3) << 16) | (0x0 << 3)) |
| 26 | #define GRF_MOBILE_DDR_EN (((0x1 << 4) << 16) | (0x1 << 4)) |
| 27 | #define GRF_MOBILE_DDR_DISB (((0x1 << 4) << 16) | (0x0 << 4)) |
| 28 | #define GRF_DDR3_EN (((0x1 << 2) << 16) | (0x1 << 2)) |
| 29 | #define GRF_LPDDR2_3_EN (((0x1 << 2) << 16) | (0x0 << 2)) |
| 30 | |
| 31 | /* PMUGRF_SOC_CON0 */ |
| 32 | #define ddrphy_bufferen_io_en(n) ((0x1 << (9 + 16)) | (n << 9)) |
| 33 | #define ddrphy_bufferen_core_en(n) ((0x1 << (8 + 16)) | (n << 8)) |
| 34 | |
| 35 | struct PCTRL_TIMING_TAG { |
| 36 | uint32_t ddrfreq; |
| 37 | uint32_t TOGCNT1U; |
| 38 | uint32_t TINIT; |
| 39 | uint32_t TRSTH; |
| 40 | uint32_t TOGCNT100N; |
| 41 | uint32_t TREFI; |
| 42 | uint32_t TMRD; |
| 43 | uint32_t TRFC; |
| 44 | uint32_t TRP; |
| 45 | uint32_t TRTW; |
| 46 | uint32_t TAL; |
| 47 | uint32_t TCL; |
| 48 | uint32_t TCWL; |
| 49 | uint32_t TRAS; |
| 50 | uint32_t TRC; |
| 51 | uint32_t TRCD; |
| 52 | uint32_t TRRD; |
| 53 | uint32_t TRTP; |
| 54 | uint32_t TWR; |
| 55 | uint32_t TWTR; |
| 56 | uint32_t TEXSR; |
| 57 | uint32_t TXP; |
| 58 | uint32_t TXPDLL; |
| 59 | uint32_t TZQCS; |
| 60 | uint32_t TZQCSI; |
| 61 | uint32_t TDQS; |
| 62 | uint32_t TCKSRE; |
| 63 | uint32_t TCKSRX; |
| 64 | uint32_t TCKE; |
| 65 | uint32_t TMOD; |
| 66 | uint32_t TRSTL; |
| 67 | uint32_t TZQCL; |
| 68 | uint32_t TMRR; |
| 69 | uint32_t TCKESR; |
| 70 | uint32_t TDPD; |
| 71 | uint32_t TREFI_MEM_DDR3; |
| 72 | }; |
| 73 | |
| 74 | struct MSCH_SAVE_REG_TAG { |
| 75 | uint32_t ddrconf; |
| 76 | uint32_t ddrtiming; |
| 77 | uint32_t ddrmode; |
| 78 | uint32_t readlatency; |
| 79 | uint32_t activate; |
| 80 | uint32_t devtodev; |
| 81 | }; |
| 82 | |
| 83 | /* ddr suspend need save reg */ |
| 84 | struct PCTL_SAVE_REG_TAG { |
| 85 | uint32_t SCFG; |
| 86 | uint32_t CMDTSTATEN; |
| 87 | uint32_t MCFG1; |
| 88 | uint32_t MCFG; |
| 89 | uint32_t PPCFG; |
| 90 | struct PCTRL_TIMING_TAG pctl_timing; |
| 91 | /* DFI Control Registers */ |
| 92 | uint32_t DFITCTRLDELAY; |
| 93 | uint32_t DFIODTCFG; |
| 94 | uint32_t DFIODTCFG1; |
| 95 | uint32_t DFIODTRANKMAP; |
| 96 | /* DFI Write Data Registers */ |
| 97 | uint32_t DFITPHYWRDATA; |
| 98 | uint32_t DFITPHYWRLAT; |
| 99 | uint32_t DFITPHYWRDATALAT; |
| 100 | /* DFI Read Data Registers */ |
| 101 | uint32_t DFITRDDATAEN; |
| 102 | uint32_t DFITPHYRDLAT; |
| 103 | /* DFI Update Registers */ |
| 104 | uint32_t DFITPHYUPDTYPE0; |
| 105 | uint32_t DFITPHYUPDTYPE1; |
| 106 | uint32_t DFITPHYUPDTYPE2; |
| 107 | uint32_t DFITPHYUPDTYPE3; |
| 108 | uint32_t DFITCTRLUPDMIN; |
| 109 | uint32_t DFITCTRLUPDMAX; |
| 110 | uint32_t DFITCTRLUPDDLY; |
| 111 | uint32_t DFIUPDCFG; |
| 112 | uint32_t DFITREFMSKI; |
| 113 | uint32_t DFITCTRLUPDI; |
| 114 | /* DFI Status Registers */ |
| 115 | uint32_t DFISTCFG0; |
| 116 | uint32_t DFISTCFG1; |
| 117 | uint32_t DFITDRAMCLKEN; |
| 118 | uint32_t DFITDRAMCLKDIS; |
| 119 | uint32_t DFISTCFG2; |
| 120 | /* DFI Low Power Register */ |
| 121 | uint32_t DFILPCFG0; |
| 122 | }; |
| 123 | |
| 124 | struct DDRPHY_SAVE_REG_TAG { |
| 125 | uint32_t PHY_REG0; |
| 126 | uint32_t PHY_REG1; |
| 127 | uint32_t PHY_REGB; |
| 128 | uint32_t PHY_REGC; |
| 129 | uint32_t PHY_REG11; |
| 130 | uint32_t PHY_REG13; |
| 131 | uint32_t PHY_REG14; |
| 132 | uint32_t PHY_REG16; |
| 133 | uint32_t PHY_REG20; |
| 134 | uint32_t PHY_REG21; |
| 135 | uint32_t PHY_REG26; |
| 136 | uint32_t PHY_REG27; |
| 137 | uint32_t PHY_REG28; |
| 138 | uint32_t PHY_REG30; |
| 139 | uint32_t PHY_REG31; |
| 140 | uint32_t PHY_REG36; |
| 141 | uint32_t PHY_REG37; |
| 142 | uint32_t PHY_REG38; |
| 143 | uint32_t PHY_REG40; |
| 144 | uint32_t PHY_REG41; |
| 145 | uint32_t PHY_REG46; |
| 146 | uint32_t PHY_REG47; |
| 147 | uint32_t PHY_REG48; |
| 148 | uint32_t PHY_REG50; |
| 149 | uint32_t PHY_REG51; |
| 150 | uint32_t PHY_REG56; |
| 151 | uint32_t PHY_REG57; |
| 152 | uint32_t PHY_REG58; |
| 153 | uint32_t PHY_REGDLL; |
| 154 | uint32_t PHY_REGEC; |
| 155 | uint32_t PHY_REGED; |
| 156 | uint32_t PHY_REGEE; |
| 157 | uint32_t PHY_REGEF; |
| 158 | uint32_t PHY_REGFB; |
| 159 | uint32_t PHY_REGFC; |
| 160 | uint32_t PHY_REGFD; |
| 161 | uint32_t PHY_REGFE; |
| 162 | }; |
| 163 | |
| 164 | struct BACKUP_REG_TAG { |
| 165 | uint32_t tag; |
| 166 | uint32_t pctladdr; |
| 167 | struct PCTL_SAVE_REG_TAG pctl; |
| 168 | uint32_t phyaddr; |
| 169 | struct DDRPHY_SAVE_REG_TAG phy; |
| 170 | uint32_t nocaddr; |
| 171 | struct MSCH_SAVE_REG_TAG noc; |
| 172 | uint32_t pllselect; |
| 173 | uint32_t phypllockaddr; |
| 174 | uint32_t phyplllockmask; |
| 175 | uint32_t phyplllockval; |
| 176 | uint32_t pllpdstat; |
| 177 | uint32_t dpllmodeaddr; |
| 178 | uint32_t dpllslowmode; |
| 179 | uint32_t dpllnormalmode; |
| 180 | uint32_t dpllresetaddr; |
| 181 | uint32_t dpllreset; |
| 182 | uint32_t dplldereset; |
| 183 | uint32_t dpllconaddr; |
| 184 | uint32_t dpllcon[4]; |
| 185 | uint32_t dplllockaddr; |
| 186 | uint32_t dplllockmask; |
| 187 | uint32_t dplllockval; |
| 188 | uint32_t ddrpllsrcdivaddr; |
| 189 | uint32_t ddrpllsrcdiv; |
| 190 | uint32_t retendisaddr; |
| 191 | uint32_t retendisval; |
| 192 | uint32_t grfregaddr; |
| 193 | uint32_t grfddrcreg; |
| 194 | uint32_t crupctlphysoftrstaddr; |
| 195 | uint32_t cruresetpctlphy; |
| 196 | uint32_t cruderesetphy; |
| 197 | uint32_t cruderesetpctlphy; |
| 198 | uint32_t physoftrstaddr; |
| 199 | uint32_t endtag; |
| 200 | }; |
| 201 | |
| 202 | static uint32_t ddr_get_phy_pll_freq(void) |
| 203 | { |
| 204 | uint32_t ret = 0; |
| 205 | uint32_t fb_div, pre_div; |
| 206 | |
| 207 | fb_div = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REGEC); |
| 208 | fb_div |= (mmio_read_32(DDR_PHY_BASE + DDR_PHY_REGED) & 0x1) << 8; |
| 209 | |
| 210 | pre_div = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REGEE) & 0xff; |
| 211 | ret = 2 * 24 * fb_div / (4 * pre_div); |
| 212 | |
| 213 | return ret; |
| 214 | } |
| 215 | |
| 216 | static void ddr_copy(uint32_t *pdest, uint32_t *psrc, uint32_t words) |
| 217 | { |
| 218 | uint32_t i; |
| 219 | |
| 220 | for (i = 0; i < words; i++) |
| 221 | pdest[i] = psrc[i]; |
| 222 | } |
| 223 | |
| 224 | static void ddr_get_dpll_cfg(uint32_t *p) |
| 225 | { |
| 226 | uint32_t nmhz, NO, NF, NR; |
| 227 | |
| 228 | nmhz = ddr_get_phy_pll_freq(); |
| 229 | if (nmhz <= 150) |
| 230 | NO = 6; |
| 231 | else if (nmhz <= 250) |
| 232 | NO = 4; |
| 233 | else if (nmhz <= 500) |
| 234 | NO = 2; |
| 235 | else |
| 236 | NO = 1; |
| 237 | |
| 238 | NR = 1; |
| 239 | NF = 2 * nmhz * NR * NO / 24; |
| 240 | |
| 241 | p[0] = SET_NR(NR) | SET_NO(NO); |
| 242 | p[1] = SET_NF(NF); |
| 243 | p[2] = SET_NB(NF / 2); |
| 244 | } |
| 245 | |
| 246 | void ddr_reg_save(uint32_t pllpdstat, uint64_t base_addr) |
| 247 | { |
| 248 | struct BACKUP_REG_TAG *p_ddr_reg = (struct BACKUP_REG_TAG *)base_addr; |
| 249 | struct PCTL_SAVE_REG_TAG *pctl_tim = &p_ddr_reg->pctl; |
| 250 | |
| 251 | p_ddr_reg->tag = 0x56313031; |
| 252 | p_ddr_reg->pctladdr = DDR_PCTL_BASE; |
| 253 | p_ddr_reg->phyaddr = DDR_PHY_BASE; |
| 254 | p_ddr_reg->nocaddr = SERVICE_BUS_BASE; |
| 255 | |
| 256 | /* PCTLR */ |
| 257 | ddr_copy((uint32_t *)&pctl_tim->pctl_timing.TOGCNT1U, |
| 258 | (uint32_t *)(DDR_PCTL_BASE + DDR_PCTL_TOGCNT1U), 35); |
| 259 | pctl_tim->pctl_timing.TREFI |= DDR_UPD_REF_ENABLE; |
| 260 | pctl_tim->SCFG = mmio_read_32(DDR_PCTL_BASE + DDR_PCTL_SCFG); |
| 261 | pctl_tim->CMDTSTATEN = mmio_read_32(DDR_PCTL_BASE + |
| 262 | DDR_PCTL_CMDTSTATEN); |
| 263 | pctl_tim->MCFG1 = mmio_read_32(DDR_PCTL_BASE + DDR_PCTL_MCFG1); |
| 264 | pctl_tim->MCFG = mmio_read_32(DDR_PCTL_BASE + DDR_PCTL_MCFG); |
| 265 | pctl_tim->PPCFG = mmio_read_32(DDR_PCTL_BASE + DDR_PCTL_PPCFG); |
| 266 | pctl_tim->pctl_timing.ddrfreq = mmio_read_32(DDR_PCTL_BASE + |
| 267 | DDR_PCTL_TOGCNT1U * 2); |
| 268 | pctl_tim->DFITCTRLDELAY = mmio_read_32(DDR_PCTL_BASE + |
| 269 | DDR_PCTL_DFITCTRLDELAY); |
| 270 | pctl_tim->DFIODTCFG = mmio_read_32(DDR_PCTL_BASE + DDR_PCTL_DFIODTCFG); |
| 271 | pctl_tim->DFIODTCFG1 = mmio_read_32(DDR_PCTL_BASE + |
| 272 | DDR_PCTL_DFIODTCFG1); |
| 273 | pctl_tim->DFIODTRANKMAP = mmio_read_32(DDR_PCTL_BASE + |
| 274 | DDR_PCTL_DFIODTRANKMAP); |
| 275 | pctl_tim->DFITPHYWRDATA = mmio_read_32(DDR_PCTL_BASE + |
| 276 | DDR_PCTL_DFITPHYWRDATA); |
| 277 | pctl_tim->DFITPHYWRLAT = mmio_read_32(DDR_PCTL_BASE + |
| 278 | DDR_PCTL_DFITPHYWRLAT); |
| 279 | pctl_tim->DFITPHYWRDATALAT = mmio_read_32(DDR_PCTL_BASE + |
| 280 | DDR_PCTL_DFITPHYWRDATALAT); |
| 281 | pctl_tim->DFITRDDATAEN = mmio_read_32(DDR_PCTL_BASE + |
| 282 | DDR_PCTL_DFITRDDATAEN); |
| 283 | pctl_tim->DFITPHYRDLAT = mmio_read_32(DDR_PCTL_BASE + |
| 284 | DDR_PCTL_DFITPHYRDLAT); |
| 285 | pctl_tim->DFITPHYUPDTYPE0 = mmio_read_32(DDR_PCTL_BASE + |
| 286 | DDR_PCTL_DFITPHYUPDTYPE0); |
| 287 | pctl_tim->DFITPHYUPDTYPE1 = mmio_read_32(DDR_PCTL_BASE + |
| 288 | DDR_PCTL_DFITPHYUPDTYPE1); |
| 289 | pctl_tim->DFITPHYUPDTYPE2 = mmio_read_32(DDR_PCTL_BASE + |
| 290 | DDR_PCTL_DFITPHYUPDTYPE2); |
| 291 | pctl_tim->DFITPHYUPDTYPE3 = mmio_read_32(DDR_PCTL_BASE + |
| 292 | DDR_PCTL_DFITPHYUPDTYPE3); |
| 293 | pctl_tim->DFITCTRLUPDMIN = mmio_read_32(DDR_PCTL_BASE + |
| 294 | DDR_PCTL_DFITCTRLUPDMIN); |
| 295 | pctl_tim->DFITCTRLUPDMAX = mmio_read_32(DDR_PCTL_BASE + |
| 296 | DDR_PCTL_DFITCTRLUPDMAX); |
| 297 | pctl_tim->DFITCTRLUPDDLY = mmio_read_32(DDR_PCTL_BASE + |
| 298 | DDR_PCTL_DFITCTRLUPDDLY); |
| 299 | |
| 300 | pctl_tim->DFIUPDCFG = mmio_read_32(DDR_PCTL_BASE + DDR_PCTL_DFIUPDCFG); |
| 301 | pctl_tim->DFITREFMSKI = mmio_read_32(DDR_PCTL_BASE + |
| 302 | DDR_PCTL_DFITREFMSKI); |
| 303 | pctl_tim->DFITCTRLUPDI = mmio_read_32(DDR_PCTL_BASE + |
| 304 | DDR_PCTL_DFITCTRLUPDI); |
| 305 | pctl_tim->DFISTCFG0 = mmio_read_32(DDR_PCTL_BASE + DDR_PCTL_DFISTCFG0); |
| 306 | pctl_tim->DFISTCFG1 = mmio_read_32(DDR_PCTL_BASE + DDR_PCTL_DFISTCFG1); |
| 307 | pctl_tim->DFITDRAMCLKEN = mmio_read_32(DDR_PCTL_BASE + |
| 308 | DDR_PCTL_DFITDRAMCLKEN); |
| 309 | pctl_tim->DFITDRAMCLKDIS = mmio_read_32(DDR_PCTL_BASE + |
| 310 | DDR_PCTL_DFITDRAMCLKDIS); |
| 311 | pctl_tim->DFISTCFG2 = mmio_read_32(DDR_PCTL_BASE + DDR_PCTL_DFISTCFG2); |
| 312 | pctl_tim->DFILPCFG0 = mmio_read_32(DDR_PCTL_BASE + DDR_PCTL_DFILPCFG0); |
| 313 | |
| 314 | /* PHY */ |
| 315 | p_ddr_reg->phy.PHY_REG0 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG0); |
| 316 | p_ddr_reg->phy.PHY_REG1 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG1); |
| 317 | p_ddr_reg->phy.PHY_REGB = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REGB); |
| 318 | p_ddr_reg->phy.PHY_REGC = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REGC); |
| 319 | p_ddr_reg->phy.PHY_REG11 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG11); |
| 320 | p_ddr_reg->phy.PHY_REG13 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG13); |
| 321 | p_ddr_reg->phy.PHY_REG14 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG14); |
| 322 | p_ddr_reg->phy.PHY_REG16 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG16); |
| 323 | p_ddr_reg->phy.PHY_REG20 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG20); |
| 324 | p_ddr_reg->phy.PHY_REG21 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG21); |
| 325 | p_ddr_reg->phy.PHY_REG26 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG26); |
| 326 | p_ddr_reg->phy.PHY_REG27 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG27); |
| 327 | p_ddr_reg->phy.PHY_REG28 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG28); |
| 328 | p_ddr_reg->phy.PHY_REG30 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG30); |
| 329 | p_ddr_reg->phy.PHY_REG31 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG31); |
| 330 | p_ddr_reg->phy.PHY_REG36 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG36); |
| 331 | p_ddr_reg->phy.PHY_REG37 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG37); |
| 332 | p_ddr_reg->phy.PHY_REG38 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG38); |
| 333 | p_ddr_reg->phy.PHY_REG40 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG40); |
| 334 | p_ddr_reg->phy.PHY_REG41 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG41); |
| 335 | p_ddr_reg->phy.PHY_REG46 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG46); |
| 336 | p_ddr_reg->phy.PHY_REG47 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG47); |
| 337 | p_ddr_reg->phy.PHY_REG48 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG48); |
| 338 | p_ddr_reg->phy.PHY_REG50 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG50); |
| 339 | p_ddr_reg->phy.PHY_REG51 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG51); |
| 340 | p_ddr_reg->phy.PHY_REG56 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG56); |
| 341 | p_ddr_reg->phy.PHY_REG57 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG57); |
| 342 | p_ddr_reg->phy.PHY_REG58 = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG58); |
| 343 | p_ddr_reg->phy.PHY_REGDLL = mmio_read_32(DDR_PHY_BASE + |
| 344 | DDR_PHY_REGDLL); |
| 345 | p_ddr_reg->phy.PHY_REGEC = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REGEC); |
| 346 | p_ddr_reg->phy.PHY_REGED = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REGED); |
| 347 | p_ddr_reg->phy.PHY_REGEE = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REGEE); |
| 348 | p_ddr_reg->phy.PHY_REGEF = 0; |
| 349 | |
| 350 | if (mmio_read_32(DDR_PHY_BASE + DDR_PHY_REG2) & 0x2) { |
| 351 | p_ddr_reg->phy.PHY_REGFB = mmio_read_32(DDR_PHY_BASE + |
| 352 | DDR_PHY_REG2C); |
| 353 | p_ddr_reg->phy.PHY_REGFC = mmio_read_32(DDR_PHY_BASE + |
| 354 | DDR_PHY_REG3C); |
| 355 | p_ddr_reg->phy.PHY_REGFD = mmio_read_32(DDR_PHY_BASE + |
| 356 | DDR_PHY_REG4C); |
| 357 | p_ddr_reg->phy.PHY_REGFE = mmio_read_32(DDR_PHY_BASE + |
| 358 | DDR_PHY_REG5C); |
| 359 | } else { |
| 360 | p_ddr_reg->phy.PHY_REGFB = mmio_read_32(DDR_PHY_BASE + |
| 361 | DDR_PHY_REGFB); |
| 362 | p_ddr_reg->phy.PHY_REGFC = mmio_read_32(DDR_PHY_BASE + |
| 363 | DDR_PHY_REGFC); |
| 364 | p_ddr_reg->phy.PHY_REGFD = mmio_read_32(DDR_PHY_BASE + |
| 365 | DDR_PHY_REGFD); |
| 366 | p_ddr_reg->phy.PHY_REGFE = mmio_read_32(DDR_PHY_BASE + |
| 367 | DDR_PHY_REGFE); |
| 368 | } |
| 369 | |
| 370 | /* NOC */ |
| 371 | p_ddr_reg->noc.ddrconf = mmio_read_32(SERVICE_BUS_BASE + MSCH_DDRCONF); |
| 372 | p_ddr_reg->noc.ddrtiming = mmio_read_32(SERVICE_BUS_BASE + |
| 373 | MSCH_DDRTIMING); |
| 374 | p_ddr_reg->noc.ddrmode = mmio_read_32(SERVICE_BUS_BASE + MSCH_DDRMODE); |
| 375 | p_ddr_reg->noc.readlatency = mmio_read_32(SERVICE_BUS_BASE + |
| 376 | MSCH_READLATENCY); |
| 377 | p_ddr_reg->noc.activate = mmio_read_32(SERVICE_BUS_BASE + |
| 378 | MSCH_ACTIVATE); |
| 379 | p_ddr_reg->noc.devtodev = mmio_read_32(SERVICE_BUS_BASE + |
| 380 | MSCH_DEVTODEV); |
| 381 | |
| 382 | p_ddr_reg->pllselect = mmio_read_32(DDR_PHY_BASE + DDR_PHY_REGEE) * 0x1; |
| 383 | p_ddr_reg->phypllockaddr = GRF_BASE + GRF_SOC_STATUS0; |
| 384 | p_ddr_reg->phyplllockmask = GRF_DDRPHY_LOCK; |
| 385 | p_ddr_reg->phyplllockval = 0; |
| 386 | |
| 387 | /* PLLPD */ |
| 388 | p_ddr_reg->pllpdstat = pllpdstat; |
| 389 | /* DPLL */ |
| 390 | p_ddr_reg->dpllmodeaddr = CRU_BASE + PLL_CONS(DPLL_ID, 3); |
| 391 | /* slow mode and power on */ |
| 392 | p_ddr_reg->dpllslowmode = DPLL_WORK_SLOW_MODE | DPLL_POWER_DOWN; |
| 393 | p_ddr_reg->dpllnormalmode = DPLL_WORK_NORMAL_MODE; |
| 394 | p_ddr_reg->dpllresetaddr = CRU_BASE + PLL_CONS(DPLL_ID, 3); |
| 395 | p_ddr_reg->dpllreset = DPLL_RESET_CONTROL_NORMAL; |
| 396 | p_ddr_reg->dplldereset = DPLL_RESET_CONTROL_RESET; |
| 397 | p_ddr_reg->dpllconaddr = CRU_BASE + PLL_CONS(DPLL_ID, 0); |
| 398 | |
| 399 | if (p_ddr_reg->pllselect == 0) { |
| 400 | p_ddr_reg->dpllcon[0] = (mmio_read_32(CRU_BASE + |
| 401 | PLL_CONS(DPLL_ID, 0)) |
| 402 | & 0xffff) | |
Justin Chadwell | 2b558a6 | 2019-07-03 14:11:28 +0100 | [diff] [blame] | 403 | (0xFFFFu << 16); |
Tony Xie | f6118cc | 2016-01-15 17:17:32 +0800 | [diff] [blame] | 404 | p_ddr_reg->dpllcon[1] = (mmio_read_32(CRU_BASE + |
| 405 | PLL_CONS(DPLL_ID, 1)) |
| 406 | & 0xffff); |
| 407 | p_ddr_reg->dpllcon[2] = (mmio_read_32(CRU_BASE + |
| 408 | PLL_CONS(DPLL_ID, 2)) |
| 409 | & 0xffff); |
| 410 | p_ddr_reg->dpllcon[3] = (mmio_read_32(CRU_BASE + |
| 411 | PLL_CONS(DPLL_ID, 3)) |
| 412 | & 0xffff) | |
Justin Chadwell | 2b558a6 | 2019-07-03 14:11:28 +0100 | [diff] [blame] | 413 | (0xFFFFu << 16); |
Tony Xie | f6118cc | 2016-01-15 17:17:32 +0800 | [diff] [blame] | 414 | } else { |
| 415 | ddr_get_dpll_cfg(&p_ddr_reg->dpllcon[0]); |
| 416 | } |
| 417 | |
| 418 | p_ddr_reg->pllselect = 0; |
| 419 | p_ddr_reg->dplllockaddr = CRU_BASE + PLL_CONS(DPLL_ID, 1); |
| 420 | p_ddr_reg->dplllockmask = DPLL_STATUS_LOCK; |
| 421 | p_ddr_reg->dplllockval = DPLL_STATUS_LOCK; |
| 422 | |
| 423 | /* SET_DDR_PLL_SRC */ |
| 424 | p_ddr_reg->ddrpllsrcdivaddr = CRU_BASE + CRU_CLKSELS_CON(13); |
| 425 | p_ddr_reg->ddrpllsrcdiv = (mmio_read_32(CRU_BASE + CRU_CLKSELS_CON(13)) |
| 426 | & DDR_PLL_SRC_MASK) |
| 427 | | (DDR_PLL_SRC_MASK << 16); |
| 428 | p_ddr_reg->retendisaddr = PMU_BASE + PMU_PWRMD_COM; |
| 429 | p_ddr_reg->retendisval = PD_PERI_PWRDN_ENABLE; |
| 430 | p_ddr_reg->grfregaddr = GRF_BASE + GRF_DDRC0_CON0; |
| 431 | p_ddr_reg->grfddrcreg = (mmio_read_32(GRF_BASE + GRF_DDRC0_CON0) & |
| 432 | DDR_PLL_SRC_MASK) | |
| 433 | (DDR_PLL_SRC_MASK << 16); |
| 434 | |
| 435 | /* pctl phy soft reset */ |
| 436 | p_ddr_reg->crupctlphysoftrstaddr = CRU_BASE + CRU_SOFTRSTS_CON(10); |
| 437 | p_ddr_reg->cruresetpctlphy = DDRCTRL0_PSRSTN_REQ(1) | |
| 438 | DDRCTRL0_SRSTN_REQ(1) | |
| 439 | DDRPHY0_PSRSTN_REQ(1) | |
| 440 | DDRPHY0_SRSTN_REQ(1); |
| 441 | p_ddr_reg->cruderesetphy = DDRCTRL0_PSRSTN_REQ(1) | |
| 442 | DDRCTRL0_SRSTN_REQ(1) | |
| 443 | DDRPHY0_PSRSTN_REQ(0) | |
| 444 | DDRPHY0_SRSTN_REQ(0); |
| 445 | |
| 446 | p_ddr_reg->cruderesetpctlphy = DDRCTRL0_PSRSTN_REQ(0) | |
| 447 | DDRCTRL0_SRSTN_REQ(0) | |
| 448 | DDRPHY0_PSRSTN_REQ(0) | |
| 449 | DDRPHY0_SRSTN_REQ(0); |
| 450 | |
| 451 | p_ddr_reg->physoftrstaddr = DDR_PHY_BASE + DDR_PHY_REG0; |
| 452 | |
| 453 | p_ddr_reg->endtag = 0xFFFFFFFF; |
| 454 | } |
| 455 | |
| 456 | /* |
| 457 | * "rk3368_ddr_reg_resume_V1.05.bin" is an executable bin which is generated |
| 458 | * by ARM DS5 for resuming ddr controller. If the soc wakes up from system |
| 459 | * suspend, ddr needs to be resumed and the resuming code needs to be run in |
| 460 | * sram. But there is not a way to pointing the resuming code to the PMUSRAM |
| 461 | * when linking .o files of bl31, so we use the |
| 462 | * "rk3368_ddr_reg_resume_V1.05.bin" whose code is position-independent and |
| 463 | * it can be loaded anywhere and run. |
| 464 | */ |
| 465 | static __aligned(4) unsigned int ddr_reg_resume[] = { |
| 466 | #include "rk3368_ddr_reg_resume_V1.05.bin" |
| 467 | }; |
| 468 | |
| 469 | uint32_t ddr_get_resume_code_size(void) |
| 470 | { |
| 471 | return sizeof(ddr_reg_resume); |
| 472 | } |
| 473 | |
| 474 | uint32_t ddr_get_resume_data_size(void) |
| 475 | { |
| 476 | return sizeof(struct BACKUP_REG_TAG); |
| 477 | } |
| 478 | |
| 479 | uint32_t *ddr_get_resume_code_base(void) |
| 480 | { |
| 481 | return (unsigned int *)ddr_reg_resume; |
| 482 | } |