123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509 |
- #include <linux/clk.h>
- #include <linux/delay.h>
- #include <linux/io.h>
- #include <linux/iopoll.h>
- #include <linux/module.h>
- #include <linux/of.h>
- #include <linux/phy/phy.h>
- #include <linux/platform_device.h>
- #define CTRL_CFG_0 0x00
- #define CTRL_CFG_1 0x04
- #define CTRL_PRESET_0 0x08
- #define CTRL_PRESET_1 0x0c
- #define CTRL_PRESET_2 0x10
- #define CTRL_PRESET_3 0x14
- #define CTRL_PRESET_4 0x18
- #define CTRL_CFG_2 0x1c
- #define CTRL_CFG_3 0x20
- #define PHY_CFG_0 0x24
- #define PHY_CFG_1 0x28
- #define PHY_CFG_2 0x2c
- #define PHYBIST_CTRL 0x30
- #define SDHC_STAT3 0x34
- #define PHY_STAT 0x38
- #define PHYBIST_STAT_0 0x3c
- #define PHYBIST_STAT_1 0x40
- #define EMMC_AXI 0x44
- #define CTRL_PRESET3_MASK GENMASK(31, 0)
- #define CTRL_PRESET3_SHIFT 0
- #define SUPPORT_HS_MASK BIT(26)
- #define SUPPORT_HS_SHIFT 26
- #define SUPPORT_8B_MASK BIT(24)
- #define SUPPORT_8B_SHIFT 24
- #define SUPPORT_SDR50_MASK BIT(28)
- #define SUPPORT_SDR50_SHIFT 28
- #define SLOT_TYPE_MASK GENMASK(27, 26)
- #define SLOT_TYPE_OFFSET 26
- #define SUPPORT_64B_MASK BIT(24)
- #define SUPPORT_64B_SHIFT 24
- #define SUPPORT_HS400_MASK BIT(2)
- #define SUPPORT_HS400_SHIFT 2
- #define SUPPORT_DDR50_MASK BIT(1)
- #define SUPPORT_DDR50_SHIFT 1
- #define SUPPORT_SDR104_MASK BIT(0)
- #define SUPPORT_SDR104_SHIFT 0
- #define SEL_DLY_TXCLK_MASK BIT(29)
- #define SEL_DLY_TXCLK_SHIFT 29
- #define SEL_DLY_RXCLK_MASK BIT(28)
- #define SEL_DLY_RXCLK_SHIFT 28
- #define OTAP_DLY_ENA_MASK BIT(27)
- #define OTAP_DLY_ENA_SHIFT 27
- #define OTAP_DLY_SEL_MASK GENMASK(26, 23)
- #define OTAP_DLY_SEL_SHIFT 23
- #define ITAP_CHG_WIN_MASK BIT(22)
- #define ITAP_CHG_WIN_SHIFT 22
- #define ITAP_DLY_ENA_MASK BIT(21)
- #define ITAP_DLY_ENA_SHIFT 21
- #define ITAP_DLY_SEL_MASK GENMASK(20, 16)
- #define ITAP_DLY_SEL_SHIFT 16
- #define RET_ENB_MASK BIT(15)
- #define RET_ENB_SHIFT 15
- #define RET_EN_MASK BIT(14)
- #define RET_EN_SHIFT 14
- #define DLL_IFF_MASK GENMASK(13, 11)
- #define DLL_IFF_SHIFT 11
- #define DLL_EN_MASK BIT(10)
- #define DLL_EN_SHIFT 10
- #define DLL_TRIM_ICP_MASK GENMASK(9, 6)
- #define DLL_TRIM_ICP_SHIFT 6
- #define RETRIM_EN_MASK BIT(5)
- #define RETRIM_EN_SHIFT 5
- #define RETRIM_MASK BIT(4)
- #define RETRIM_SHIFT 4
- #define DR_TY_MASK GENMASK(3, 1)
- #define DR_TY_SHIFT 1
- #define PWR_DOWN_MASK BIT(0)
- #define PWR_DOWN_SHIFT 0
- #define REN_DAT_MASK GENMASK(19, 12)
- #define REN_DAT_SHIFT 12
- #define REN_CMD_MASK BIT(11)
- #define REN_CMD_SHIFT 11
- #define REN_STRB_MASK BIT(10)
- #define REN_STRB_SHIFT 10
- #define PU_STRB_MASK BIT(20)
- #define PU_STRB_SHIFT 20
- #define CLKBUF_MASK GENMASK(24, 21)
- #define CLKBUF_SHIFT 21
- #define SEL_STRB_MASK GENMASK(20, 13)
- #define SEL_STRB_SHIFT 13
- #define SEL_FREQ_MASK GENMASK(12, 10)
- #define SEL_FREQ_SHIFT 10
- #define CAL_DONE BIT(6)
- #define DLL_RDY BIT(5)
- #define OTAP_DLY 0x0
- #define ITAP_DLY 0x0
- #define STRB 0x33
- #define FREQSEL_200M_170M 0x0
- #define FREQSEL_170M_140M 0x1
- #define FREQSEL_140M_110M 0x2
- #define FREQSEL_110M_80M 0x3
- #define FREQSEL_80M_50M 0x4
- #define FREQSEL_275M_250M 0x5
- #define FREQSEL_250M_225M 0x6
- #define FREQSEL_225M_200M 0x7
- #define PHY_UNINITIALIZED 0
- #define PHY_INITIALIZED 1
- struct thunderbay_emmc_phy {
- void __iomem *reg_base;
- struct clk *emmcclk;
- int phy_power_sts;
- };
- static inline void update_reg(struct thunderbay_emmc_phy *tbh_phy, u32 offset,
- u32 mask, u32 shift, u32 val)
- {
- u32 tmp;
- tmp = readl(tbh_phy->reg_base + offset);
- tmp &= ~mask;
- tmp |= val << shift;
- writel(tmp, tbh_phy->reg_base + offset);
- }
- static int thunderbay_emmc_phy_power(struct phy *phy, bool power_on)
- {
- struct thunderbay_emmc_phy *tbh_phy = phy_get_drvdata(phy);
- unsigned int freqsel = FREQSEL_200M_170M;
- unsigned long rate;
- static int lock;
- u32 val;
- int ret;
-
- rate = clk_get_rate(tbh_phy->emmcclk);
- switch (rate) {
- case 200000000:
-
- update_reg(tbh_phy, PHY_CFG_0, DLL_EN_MASK, DLL_EN_SHIFT, 0x0);
- break;
-
- case 50000000 ... 52000000:
- case 400000:
- default:
- break;
- }
- if (!power_on)
- return 0;
- rate = clk_get_rate(tbh_phy->emmcclk);
- switch (rate) {
- case 170000001 ... 200000000:
- freqsel = FREQSEL_200M_170M;
- break;
- case 140000001 ... 170000000:
- freqsel = FREQSEL_170M_140M;
- break;
- case 110000001 ... 140000000:
- freqsel = FREQSEL_140M_110M;
- break;
- case 80000001 ... 110000000:
- freqsel = FREQSEL_110M_80M;
- break;
- case 50000000 ... 80000000:
- freqsel = FREQSEL_80M_50M;
- break;
- case 250000001 ... 275000000:
- freqsel = FREQSEL_275M_250M;
- break;
- case 225000001 ... 250000000:
- freqsel = FREQSEL_250M_225M;
- break;
- case 200000001 ... 225000000:
- freqsel = FREQSEL_225M_200M;
- break;
- default:
- break;
- }
-
- if (rate > 200000000)
- dev_warn(&phy->dev, "Unsupported rate: %lu\n", rate);
- udelay(5);
- if (lock == 0) {
-
- update_reg(tbh_phy, PHY_CFG_0, PWR_DOWN_MASK,
- PWR_DOWN_SHIFT, 0x1);
- lock = 1;
-
- ret = readl_poll_timeout(tbh_phy->reg_base + PHY_STAT,
- val, (val & CAL_DONE), 10, 50);
- if (ret) {
- dev_err(&phy->dev, "caldone failed, ret=%d\n", ret);
- return ret;
- }
- }
- rate = clk_get_rate(tbh_phy->emmcclk);
- switch (rate) {
- case 200000000:
-
- update_reg(tbh_phy, PHY_CFG_2, SEL_FREQ_MASK, SEL_FREQ_SHIFT, freqsel);
-
- update_reg(tbh_phy, PHY_CFG_0, DLL_EN_MASK, DLL_EN_SHIFT, 0x1);
-
- ret = readl_poll_timeout(tbh_phy->reg_base + PHY_STAT,
- val, (val & DLL_RDY), 10, 50 * USEC_PER_MSEC);
- if (ret) {
- dev_err(&phy->dev, "dllrdy failed, ret=%d\n", ret);
- return ret;
- }
- break;
- default:
- break;
- }
- return 0;
- }
- static int thunderbay_emmc_phy_init(struct phy *phy)
- {
- struct thunderbay_emmc_phy *tbh_phy = phy_get_drvdata(phy);
- tbh_phy->emmcclk = clk_get(&phy->dev, "emmcclk");
- return PTR_ERR_OR_ZERO(tbh_phy->emmcclk);
- }
- static int thunderbay_emmc_phy_exit(struct phy *phy)
- {
- struct thunderbay_emmc_phy *tbh_phy = phy_get_drvdata(phy);
- clk_put(tbh_phy->emmcclk);
- return 0;
- }
- static int thunderbay_emmc_phy_power_on(struct phy *phy)
- {
- struct thunderbay_emmc_phy *tbh_phy = phy_get_drvdata(phy);
- unsigned long rate;
-
- update_reg(tbh_phy, CTRL_CFG_0,
- SUPPORT_HS_MASK, SUPPORT_HS_SHIFT, 0x1);
- update_reg(tbh_phy, CTRL_CFG_0,
- SUPPORT_8B_MASK, SUPPORT_8B_SHIFT, 0x1);
- update_reg(tbh_phy, CTRL_CFG_1,
- SUPPORT_SDR50_MASK, SUPPORT_SDR50_SHIFT, 0x1);
- update_reg(tbh_phy, CTRL_CFG_1,
- SUPPORT_DDR50_MASK, SUPPORT_DDR50_SHIFT, 0x1);
- update_reg(tbh_phy, CTRL_CFG_1,
- SUPPORT_SDR104_MASK, SUPPORT_SDR104_SHIFT, 0x1);
- update_reg(tbh_phy, CTRL_CFG_1,
- SUPPORT_HS400_MASK, SUPPORT_HS400_SHIFT, 0x1);
- update_reg(tbh_phy, CTRL_CFG_1,
- SUPPORT_64B_MASK, SUPPORT_64B_SHIFT, 0x1);
- if (tbh_phy->phy_power_sts == PHY_UNINITIALIZED) {
-
- update_reg(tbh_phy, PHY_CFG_0, SEL_DLY_TXCLK_MASK, SEL_DLY_TXCLK_SHIFT, 0x1);
- update_reg(tbh_phy, PHY_CFG_0, SEL_DLY_RXCLK_MASK, SEL_DLY_RXCLK_SHIFT, 0x1);
- update_reg(tbh_phy, PHY_CFG_0, ITAP_DLY_ENA_MASK, ITAP_DLY_ENA_SHIFT, 0x0);
- update_reg(tbh_phy, PHY_CFG_0, ITAP_DLY_SEL_MASK, ITAP_DLY_SEL_SHIFT, 0x0);
- update_reg(tbh_phy, PHY_CFG_0, OTAP_DLY_ENA_MASK, OTAP_DLY_ENA_SHIFT, 0x0);
- update_reg(tbh_phy, PHY_CFG_0, OTAP_DLY_SEL_MASK, OTAP_DLY_SEL_SHIFT, 0);
- update_reg(tbh_phy, PHY_CFG_0, DLL_TRIM_ICP_MASK, DLL_TRIM_ICP_SHIFT, 0);
- update_reg(tbh_phy, PHY_CFG_0, DR_TY_MASK, DR_TY_SHIFT, 0x1);
- } else if (tbh_phy->phy_power_sts == PHY_INITIALIZED) {
-
- rate = clk_get_rate(tbh_phy->emmcclk);
- switch (rate) {
- case 200000000:
- update_reg(tbh_phy, PHY_CFG_0, SEL_DLY_TXCLK_MASK,
- SEL_DLY_TXCLK_SHIFT, 0x0);
- update_reg(tbh_phy, PHY_CFG_0, SEL_DLY_RXCLK_MASK,
- SEL_DLY_RXCLK_SHIFT, 0x0);
- update_reg(tbh_phy, PHY_CFG_0, ITAP_DLY_ENA_MASK,
- ITAP_DLY_ENA_SHIFT, 0x0);
- update_reg(tbh_phy, PHY_CFG_0, ITAP_DLY_SEL_MASK,
- ITAP_DLY_SEL_SHIFT, 0x0);
- update_reg(tbh_phy, PHY_CFG_0, OTAP_DLY_ENA_MASK,
- OTAP_DLY_ENA_SHIFT, 0x1);
- update_reg(tbh_phy, PHY_CFG_0, OTAP_DLY_SEL_MASK,
- OTAP_DLY_SEL_SHIFT, 2);
- update_reg(tbh_phy, PHY_CFG_0, DLL_TRIM_ICP_MASK,
- DLL_TRIM_ICP_SHIFT, 0x8);
- update_reg(tbh_phy, PHY_CFG_0, DR_TY_MASK,
- DR_TY_SHIFT, 0x1);
-
- update_reg(tbh_phy, PHY_CFG_2, SEL_STRB_MASK,
- SEL_STRB_SHIFT, STRB);
- break;
- case 50000000 ... 52000000:
-
- update_reg(tbh_phy, PHY_CFG_0, SEL_DLY_TXCLK_MASK,
- SEL_DLY_TXCLK_SHIFT, 0x1);
- update_reg(tbh_phy, PHY_CFG_0, SEL_DLY_RXCLK_MASK,
- SEL_DLY_RXCLK_SHIFT, 0x1);
- update_reg(tbh_phy, PHY_CFG_0, ITAP_DLY_ENA_MASK,
- ITAP_DLY_ENA_SHIFT, 0x0);
- update_reg(tbh_phy, PHY_CFG_0, ITAP_DLY_SEL_MASK,
- ITAP_DLY_SEL_SHIFT, 0x0);
- update_reg(tbh_phy, PHY_CFG_0, OTAP_DLY_ENA_MASK,
- OTAP_DLY_ENA_SHIFT, 0x1);
- update_reg(tbh_phy, PHY_CFG_0, OTAP_DLY_SEL_MASK,
- OTAP_DLY_SEL_SHIFT, 4);
- update_reg(tbh_phy, PHY_CFG_0, DLL_TRIM_ICP_MASK,
- DLL_TRIM_ICP_SHIFT, 0x8);
- update_reg(tbh_phy, PHY_CFG_0,
- DR_TY_MASK, DR_TY_SHIFT, 0x1);
- break;
- case 400000:
- update_reg(tbh_phy, PHY_CFG_0, SEL_DLY_TXCLK_MASK,
- SEL_DLY_TXCLK_SHIFT, 0x1);
- update_reg(tbh_phy, PHY_CFG_0, SEL_DLY_RXCLK_MASK,
- SEL_DLY_RXCLK_SHIFT, 0x1);
- update_reg(tbh_phy, PHY_CFG_0, ITAP_DLY_ENA_MASK,
- ITAP_DLY_ENA_SHIFT, 0x0);
- update_reg(tbh_phy, PHY_CFG_0, ITAP_DLY_SEL_MASK,
- ITAP_DLY_SEL_SHIFT, 0x0);
- update_reg(tbh_phy, PHY_CFG_0, OTAP_DLY_ENA_MASK,
- OTAP_DLY_ENA_SHIFT, 0x0);
- update_reg(tbh_phy, PHY_CFG_0, OTAP_DLY_SEL_MASK,
- OTAP_DLY_SEL_SHIFT, 0);
- update_reg(tbh_phy, PHY_CFG_0, DLL_TRIM_ICP_MASK,
- DLL_TRIM_ICP_SHIFT, 0);
- update_reg(tbh_phy, PHY_CFG_0, DR_TY_MASK, DR_TY_SHIFT, 0x1);
- break;
- default:
- update_reg(tbh_phy, PHY_CFG_0, SEL_DLY_TXCLK_MASK,
- SEL_DLY_TXCLK_SHIFT, 0x1);
- update_reg(tbh_phy, PHY_CFG_0, SEL_DLY_RXCLK_MASK,
- SEL_DLY_RXCLK_SHIFT, 0x1);
- update_reg(tbh_phy, PHY_CFG_0, ITAP_DLY_ENA_MASK,
- ITAP_DLY_ENA_SHIFT, 0x0);
- update_reg(tbh_phy, PHY_CFG_0, ITAP_DLY_SEL_MASK,
- ITAP_DLY_SEL_SHIFT, 0x0);
- update_reg(tbh_phy, PHY_CFG_0, OTAP_DLY_ENA_MASK,
- OTAP_DLY_ENA_SHIFT, 0x1);
- update_reg(tbh_phy, PHY_CFG_0, OTAP_DLY_SEL_MASK,
- OTAP_DLY_SEL_SHIFT, 2);
- update_reg(tbh_phy, PHY_CFG_0, DLL_TRIM_ICP_MASK,
- DLL_TRIM_ICP_SHIFT, 0x8);
- update_reg(tbh_phy, PHY_CFG_0, DR_TY_MASK,
- DR_TY_SHIFT, 0x1);
- break;
- }
-
- tbh_phy->phy_power_sts = PHY_UNINITIALIZED;
- }
- update_reg(tbh_phy, PHY_CFG_0, RETRIM_EN_MASK, RETRIM_EN_SHIFT, 0x1);
- update_reg(tbh_phy, PHY_CFG_0, RETRIM_MASK, RETRIM_SHIFT, 0x0);
- return thunderbay_emmc_phy_power(phy, 1);
- }
- static int thunderbay_emmc_phy_power_off(struct phy *phy)
- {
- struct thunderbay_emmc_phy *tbh_phy = phy_get_drvdata(phy);
- tbh_phy->phy_power_sts = PHY_INITIALIZED;
- return thunderbay_emmc_phy_power(phy, 0);
- }
- static const struct phy_ops thunderbay_emmc_phy_ops = {
- .init = thunderbay_emmc_phy_init,
- .exit = thunderbay_emmc_phy_exit,
- .power_on = thunderbay_emmc_phy_power_on,
- .power_off = thunderbay_emmc_phy_power_off,
- .owner = THIS_MODULE,
- };
- static const struct of_device_id thunderbay_emmc_phy_of_match[] = {
- { .compatible = "intel,thunderbay-emmc-phy",
- (void *)&thunderbay_emmc_phy_ops },
- {}
- };
- MODULE_DEVICE_TABLE(of, thunderbay_emmc_phy_of_match);
- static int thunderbay_emmc_phy_probe(struct platform_device *pdev)
- {
- struct thunderbay_emmc_phy *tbh_phy;
- struct phy_provider *phy_provider;
- struct device *dev = &pdev->dev;
- const struct of_device_id *id;
- struct phy *generic_phy;
- struct resource *res;
- if (!dev->of_node)
- return -ENODEV;
- tbh_phy = devm_kzalloc(dev, sizeof(*tbh_phy), GFP_KERNEL);
- if (!tbh_phy)
- return -ENOMEM;
- res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
- tbh_phy->reg_base = devm_ioremap_resource(&pdev->dev, res);
- if (IS_ERR(tbh_phy->reg_base))
- return PTR_ERR(tbh_phy->reg_base);
- tbh_phy->phy_power_sts = PHY_UNINITIALIZED;
- id = of_match_node(thunderbay_emmc_phy_of_match, pdev->dev.of_node);
- if (!id) {
- dev_err(dev, "failed to get match_node\n");
- return -EINVAL;
- }
- generic_phy = devm_phy_create(dev, dev->of_node, id->data);
- if (IS_ERR(generic_phy)) {
- dev_err(dev, "failed to create PHY\n");
- return PTR_ERR(generic_phy);
- }
- phy_set_drvdata(generic_phy, tbh_phy);
- phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate);
- return PTR_ERR_OR_ZERO(phy_provider);
- }
- static struct platform_driver thunderbay_emmc_phy_driver = {
- .probe = thunderbay_emmc_phy_probe,
- .driver = {
- .name = "thunderbay-emmc-phy",
- .of_match_table = thunderbay_emmc_phy_of_match,
- },
- };
- module_platform_driver(thunderbay_emmc_phy_driver);
- MODULE_AUTHOR("Nandhini S <nandhini.srikandan@intel.com>");
- MODULE_AUTHOR("Rashmi A <rashmi.a@intel.com>");
- MODULE_DESCRIPTION("Intel Thunder Bay eMMC PHY driver");
- MODULE_LICENSE("GPL v2");
|