123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375 |
- // SPDX-License-Identifier: GPL-2.0+
- /*
- * Texas Instruments' J721E DDRSS driver
- *
- * Copyright (C) 2019 Texas Instruments Incorporated - http://www.ti.com/
- */
- #include <common.h>
- #include <clk.h>
- #include <dm.h>
- #include <hang.h>
- #include <log.h>
- #include <ram.h>
- #include <asm/io.h>
- #include <power-domain.h>
- #include <wait_bit.h>
- #include <dm/device_compat.h>
- #include "lpddr4_obj_if.h"
- #include "lpddr4_if.h"
- #include "lpddr4_structs_if.h"
- #include "lpddr4_ctl_regs.h"
- #define SRAM_MAX 512
- #define CTRLMMR_DDR4_FSP_CLKCHNG_REQ_OFFS 0x80
- #define CTRLMMR_DDR4_FSP_CLKCHNG_ACK_OFFS 0xc0
- struct j721e_ddrss_desc {
- struct udevice *dev;
- void __iomem *ddrss_ss_cfg;
- void __iomem *ddrss_ctrl_mmr;
- struct power_domain ddrcfg_pwrdmn;
- struct power_domain ddrdata_pwrdmn;
- struct clk ddr_clk;
- struct clk osc_clk;
- u32 ddr_freq1;
- u32 ddr_freq2;
- u32 ddr_fhs_cnt;
- };
- static LPDDR4_OBJ *driverdt;
- static lpddr4_config config;
- static lpddr4_privatedata pd;
- static struct j721e_ddrss_desc *ddrss;
- #define TH_MACRO_EXP(fld, str) (fld##str)
- #define TH_FLD_MASK(fld) TH_MACRO_EXP(fld, _MASK)
- #define TH_FLD_SHIFT(fld) TH_MACRO_EXP(fld, _SHIFT)
- #define TH_FLD_WIDTH(fld) TH_MACRO_EXP(fld, _WIDTH)
- #define TH_FLD_WOCLR(fld) TH_MACRO_EXP(fld, _WOCLR)
- #define TH_FLD_WOSET(fld) TH_MACRO_EXP(fld, _WOSET)
- #define str(s) #s
- #define xstr(s) str(s)
- #define CTL_SHIFT 11
- #define PHY_SHIFT 11
- #define PI_SHIFT 10
- #define TH_OFFSET_FROM_REG(REG, SHIFT, offset) do {\
- char *i, *pstr= xstr(REG); offset = 0;\
- for (i = &pstr[SHIFT]; *i != '\0'; ++i) {\
- offset = offset * 10 + (*i - '0'); }\
- } while (0)
- static void j721e_lpddr4_ack_freq_upd_req(void)
- {
- unsigned int req_type, counter;
- debug("--->>> LPDDR4 Initialization is in progress ... <<<---\n");
- for (counter = 0; counter < ddrss->ddr_fhs_cnt; counter++) {
- if (wait_for_bit_le32(ddrss->ddrss_ctrl_mmr +
- CTRLMMR_DDR4_FSP_CLKCHNG_REQ_OFFS, 0x80,
- true, 10000, false)) {
- printf("Timeout during frequency handshake\n");
- hang();
- }
- req_type = readl(ddrss->ddrss_ctrl_mmr +
- CTRLMMR_DDR4_FSP_CLKCHNG_REQ_OFFS) & 0x03;
- debug("%s: received freq change req: req type = %d, req no. = %d \n",
- __func__, req_type, counter);
- if (req_type == 1)
- clk_set_rate(&ddrss->ddr_clk, ddrss->ddr_freq1);
- else if (req_type == 2)
- clk_set_rate(&ddrss->ddr_clk, ddrss->ddr_freq2);
- else if (req_type == 0)
- /* Put DDR pll in bypass mode */
- clk_set_rate(&ddrss->ddr_clk,
- clk_get_rate(&ddrss->osc_clk));
- else
- printf("%s: Invalid freq request type\n", __func__);
- writel(0x1, ddrss->ddrss_ctrl_mmr +
- CTRLMMR_DDR4_FSP_CLKCHNG_ACK_OFFS);
- if (wait_for_bit_le32(ddrss->ddrss_ctrl_mmr +
- CTRLMMR_DDR4_FSP_CLKCHNG_REQ_OFFS, 0x80,
- false, 10, false)) {
- printf("Timeout during frequency handshake\n");
- hang();
- }
- writel(0x0, ddrss->ddrss_ctrl_mmr +
- CTRLMMR_DDR4_FSP_CLKCHNG_ACK_OFFS);
- }
- }
- static void j721e_lpddr4_info_handler(const lpddr4_privatedata * pd,
- lpddr4_infotype infotype)
- {
- if (infotype == LPDDR4_DRV_SOC_PLL_UPDATE) {
- j721e_lpddr4_ack_freq_upd_req();
- }
- }
- static int j721e_ddrss_power_on(struct j721e_ddrss_desc *ddrss)
- {
- int ret;
- debug("%s(ddrss=%p)\n", __func__, ddrss);
- ret = power_domain_on(&ddrss->ddrcfg_pwrdmn);
- if (ret) {
- dev_err(ddrss->dev, "power_domain_on() failed: %d\n", ret);
- return ret;
- }
- ret = power_domain_on(&ddrss->ddrdata_pwrdmn);
- if (ret) {
- dev_err(ddrss->dev, "power_domain_on() failed: %d\n", ret);
- return ret;
- }
- return 0;
- }
- static int j721e_ddrss_ofdata_to_priv(struct udevice *dev)
- {
- struct j721e_ddrss_desc *ddrss = dev_get_priv(dev);
- phys_addr_t reg;
- int ret;
- debug("%s(dev=%p)\n", __func__, dev);
- reg = dev_read_addr_name(dev, "cfg");
- if (reg == FDT_ADDR_T_NONE) {
- dev_err(dev, "No reg property for DDRSS wrapper logic\n");
- return -EINVAL;
- }
- ddrss->ddrss_ss_cfg = (void *)reg;
- reg = dev_read_addr_name(dev, "ctrl_mmr_lp4");
- if (reg == FDT_ADDR_T_NONE) {
- dev_err(dev, "No reg property for CTRL MMR\n");
- return -EINVAL;
- }
- ddrss->ddrss_ctrl_mmr = (void *)reg;
- ret = power_domain_get_by_index(dev, &ddrss->ddrcfg_pwrdmn, 0);
- if (ret) {
- dev_err(dev, "power_domain_get() failed: %d\n", ret);
- return ret;
- }
- ret = power_domain_get_by_index(dev, &ddrss->ddrdata_pwrdmn, 1);
- if (ret) {
- dev_err(dev, "power_domain_get() failed: %d\n", ret);
- return ret;
- }
- ret = clk_get_by_index(dev, 0, &ddrss->ddr_clk);
- if (ret)
- dev_err(dev, "clk get failed%d\n", ret);
- ret = clk_get_by_index(dev, 1, &ddrss->osc_clk);
- if (ret)
- dev_err(dev, "clk get failed for osc clk %d\n", ret);
- ret = dev_read_u32(dev, "ti,ddr-freq1", &ddrss->ddr_freq1);
- if (ret)
- dev_err(dev, "ddr freq1 not populated %d\n", ret);
- ret = dev_read_u32(dev, "ti,ddr-freq2", &ddrss->ddr_freq2);
- if (ret)
- dev_err(dev, "ddr freq2 not populated %d\n", ret);
- ret = dev_read_u32(dev, "ti,ddr-fhs-cnt", &ddrss->ddr_fhs_cnt);
- if (ret)
- dev_err(dev, "ddr fhs cnt not populated %d\n", ret);
- /* Put DDR pll in bypass mode */
- ret = clk_set_rate(&ddrss->ddr_clk, clk_get_rate(&ddrss->osc_clk));
- if (ret)
- dev_err(dev, "ddr clk bypass failed\n");
- return ret;
- }
- void j721e_lpddr4_probe(void)
- {
- uint32_t status = 0U;
- uint16_t configsize = 0U;
- status = driverdt->probe(&config, &configsize);
- if ((status != 0) || (configsize != sizeof(lpddr4_privatedata))
- || (configsize > SRAM_MAX)) {
- printf("LPDDR4_Probe: FAIL\n");
- hang();
- } else {
- debug("LPDDR4_Probe: PASS\n");
- }
- }
- void j721e_lpddr4_init(void)
- {
- uint32_t status = 0U;
- if ((sizeof(pd) != sizeof(lpddr4_privatedata))
- || (sizeof(pd) > SRAM_MAX)) {
- printf("LPDDR4_Init: FAIL\n");
- hang();
- }
- config.ctlbase = (struct lpddr4_ctlregs_s *)ddrss->ddrss_ss_cfg;
- config.infohandler = (lpddr4_infocallback) j721e_lpddr4_info_handler;
- status = driverdt->init(&pd, &config);
- if ((status > 0U) ||
- (pd.ctlbase != (struct lpddr4_ctlregs_s *)config.ctlbase) ||
- (pd.ctlinterrupthandler != config.ctlinterrupthandler) ||
- (pd.phyindepinterrupthandler != config.phyindepinterrupthandler)) {
- printf("LPDDR4_Init: FAIL\n");
- hang();
- } else {
- debug("LPDDR4_Init: PASS\n");
- }
- }
- void populate_data_array_from_dt(lpddr4_reginitdata * reginit_data)
- {
- int ret, i;
- ret = dev_read_u32_array(ddrss->dev, "ti,ctl-data",
- (u32 *) reginit_data->denalictlreg,
- LPDDR4_CTL_REG_COUNT);
- if (ret)
- printf("Error reading ctrl data\n");
- for (i = 0; i < LPDDR4_CTL_REG_COUNT; i++)
- reginit_data->updatectlreg[i] = true;
- ret = dev_read_u32_array(ddrss->dev, "ti,pi-data",
- (u32 *) reginit_data->denaliphyindepreg,
- LPDDR4_PHY_INDEP_REG_COUNT);
- if (ret)
- printf("Error reading PI data\n");
- for (i = 0; i < LPDDR4_PHY_INDEP_REG_COUNT; i++)
- reginit_data->updatephyindepreg[i] = true;
- ret = dev_read_u32_array(ddrss->dev, "ti,phy-data",
- (u32 *) reginit_data->denaliphyreg,
- LPDDR4_PHY_REG_COUNT);
- if (ret)
- printf("Error reading PHY data\n");
- for (i = 0; i < LPDDR4_PHY_REG_COUNT; i++)
- reginit_data->updatephyreg[i] = true;
- }
- void j721e_lpddr4_hardware_reg_init(void)
- {
- uint32_t status = 0U;
- lpddr4_reginitdata reginitdata;
- populate_data_array_from_dt(®initdata);
- status = driverdt->writectlconfig(&pd, ®initdata);
- if (!status) {
- status = driverdt->writephyindepconfig(&pd, ®initdata);
- }
- if (!status) {
- status = driverdt->writephyconfig(&pd, ®initdata);
- }
- if (status) {
- printf(" ERROR: LPDDR4_HardwareRegInit failed!!\n");
- hang();
- }
- return;
- }
- void j721e_lpddr4_start(void)
- {
- uint32_t status = 0U;
- uint32_t regval = 0U;
- uint32_t offset = 0U;
- TH_OFFSET_FROM_REG(LPDDR4__START__REG, CTL_SHIFT, offset);
- status = driverdt->readreg(&pd, LPDDR4_CTL_REGS, offset, ®val);
- if ((status > 0U) || ((regval & TH_FLD_MASK(LPDDR4__START__FLD)) != 0U)) {
- printf("LPDDR4_StartTest: FAIL\n");
- hang();
- }
- status = driverdt->start(&pd);
- if (status > 0U) {
- printf("LPDDR4_StartTest: FAIL\n");
- hang();
- }
- status = driverdt->readreg(&pd, LPDDR4_CTL_REGS, offset, ®val);
- if ((status > 0U) || ((regval & TH_FLD_MASK(LPDDR4__START__FLD)) != 1U)) {
- printf("LPDDR4_Start: FAIL\n");
- hang();
- } else {
- debug("LPDDR4_Start: PASS\n");
- }
- }
- static int j721e_ddrss_probe(struct udevice *dev)
- {
- int ret;
- ddrss = dev_get_priv(dev);
- debug("%s(dev=%p)\n", __func__, dev);
- ret = j721e_ddrss_ofdata_to_priv(dev);
- if (ret)
- return ret;
- ddrss->dev = dev;
- ret = j721e_ddrss_power_on(ddrss);
- if (ret)
- return ret;
- driverdt = lpddr4_getinstance();
- j721e_lpddr4_probe();
- j721e_lpddr4_init();
- j721e_lpddr4_hardware_reg_init();
- j721e_lpddr4_start();
- return ret;
- }
- static int j721e_ddrss_get_info(struct udevice *dev, struct ram_info *info)
- {
- return 0;
- }
- static struct ram_ops j721e_ddrss_ops = {
- .get_info = j721e_ddrss_get_info,
- };
- static const struct udevice_id j721e_ddrss_ids[] = {
- {.compatible = "ti,j721e-ddrss"},
- {}
- };
- U_BOOT_DRIVER(j721e_ddrss) = {
- .name = "j721e_ddrss",
- .id = UCLASS_RAM,
- .of_match = j721e_ddrss_ids,
- .ops = &j721e_ddrss_ops,
- .probe = j721e_ddrss_probe,
- .priv_auto_alloc_size = sizeof(struct j721e_ddrss_desc),
- };
|