| // SPDX-License-Identifier: GPL-2.0+ |
| /* |
| * Copyright (c) 2016 Allwinnertech Co., Ltd. |
| * Copyright (C) 2017-2018 Bootlin |
| * |
| * Maxime Ripard <maxime.ripard@free-electrons.com> |
| */ |
| |
| #include <linux/bitops.h> |
| #include <linux/clk.h> |
| #include <linux/module.h> |
| #include <linux/of_address.h> |
| #include <linux/platform_device.h> |
| #include <linux/regmap.h> |
| #include <linux/reset.h> |
| |
| #include <linux/phy/phy.h> |
| #include <linux/phy/phy-mipi-dphy.h> |
| |
| #define SUN6I_DPHY_GCTL_REG 0x00 |
| #define SUN6I_DPHY_GCTL_LANE_NUM(n) ((((n) - 1) & 3) << 4) |
| #define SUN6I_DPHY_GCTL_EN BIT(0) |
| |
| #define SUN6I_DPHY_TX_CTL_REG 0x04 |
| #define SUN6I_DPHY_TX_CTL_HS_TX_CLK_CONT BIT(28) |
| |
| #define SUN6I_DPHY_TX_TIME0_REG 0x10 |
| #define SUN6I_DPHY_TX_TIME0_HS_TRAIL(n) (((n) & 0xff) << 24) |
| #define SUN6I_DPHY_TX_TIME0_HS_PREPARE(n) (((n) & 0xff) << 16) |
| #define SUN6I_DPHY_TX_TIME0_LP_CLK_DIV(n) ((n) & 0xff) |
| |
| #define SUN6I_DPHY_TX_TIME1_REG 0x14 |
| #define SUN6I_DPHY_TX_TIME1_CLK_POST(n) (((n) & 0xff) << 24) |
| #define SUN6I_DPHY_TX_TIME1_CLK_PRE(n) (((n) & 0xff) << 16) |
| #define SUN6I_DPHY_TX_TIME1_CLK_ZERO(n) (((n) & 0xff) << 8) |
| #define SUN6I_DPHY_TX_TIME1_CLK_PREPARE(n) ((n) & 0xff) |
| |
| #define SUN6I_DPHY_TX_TIME2_REG 0x18 |
| #define SUN6I_DPHY_TX_TIME2_CLK_TRAIL(n) ((n) & 0xff) |
| |
| #define SUN6I_DPHY_TX_TIME3_REG 0x1c |
| |
| #define SUN6I_DPHY_TX_TIME4_REG 0x20 |
| #define SUN6I_DPHY_TX_TIME4_HS_TX_ANA1(n) (((n) & 0xff) << 8) |
| #define SUN6I_DPHY_TX_TIME4_HS_TX_ANA0(n) ((n) & 0xff) |
| |
| #define SUN6I_DPHY_ANA0_REG 0x4c |
| #define SUN6I_DPHY_ANA0_REG_PWS BIT(31) |
| #define SUN6I_DPHY_ANA0_REG_DMPC BIT(28) |
| #define SUN6I_DPHY_ANA0_REG_DMPD(n) (((n) & 0xf) << 24) |
| #define SUN6I_DPHY_ANA0_REG_SLV(n) (((n) & 7) << 12) |
| #define SUN6I_DPHY_ANA0_REG_DEN(n) (((n) & 0xf) << 8) |
| |
| #define SUN6I_DPHY_ANA1_REG 0x50 |
| #define SUN6I_DPHY_ANA1_REG_VTTMODE BIT(31) |
| #define SUN6I_DPHY_ANA1_REG_CSMPS(n) (((n) & 3) << 28) |
| #define SUN6I_DPHY_ANA1_REG_SVTT(n) (((n) & 0xf) << 24) |
| |
| #define SUN6I_DPHY_ANA2_REG 0x54 |
| #define SUN6I_DPHY_ANA2_EN_P2S_CPU(n) (((n) & 0xf) << 24) |
| #define SUN6I_DPHY_ANA2_EN_P2S_CPU_MASK GENMASK(27, 24) |
| #define SUN6I_DPHY_ANA2_EN_CK_CPU BIT(4) |
| #define SUN6I_DPHY_ANA2_REG_ENIB BIT(1) |
| |
| #define SUN6I_DPHY_ANA3_REG 0x58 |
| #define SUN6I_DPHY_ANA3_EN_VTTD(n) (((n) & 0xf) << 28) |
| #define SUN6I_DPHY_ANA3_EN_VTTD_MASK GENMASK(31, 28) |
| #define SUN6I_DPHY_ANA3_EN_VTTC BIT(27) |
| #define SUN6I_DPHY_ANA3_EN_DIV BIT(26) |
| #define SUN6I_DPHY_ANA3_EN_LDOC BIT(25) |
| #define SUN6I_DPHY_ANA3_EN_LDOD BIT(24) |
| #define SUN6I_DPHY_ANA3_EN_LDOR BIT(18) |
| |
| #define SUN6I_DPHY_ANA4_REG 0x5c |
| #define SUN6I_DPHY_ANA4_REG_DMPLVC BIT(24) |
| #define SUN6I_DPHY_ANA4_REG_DMPLVD(n) (((n) & 0xf) << 20) |
| #define SUN6I_DPHY_ANA4_REG_CKDV(n) (((n) & 0x1f) << 12) |
| #define SUN6I_DPHY_ANA4_REG_TMSC(n) (((n) & 3) << 10) |
| #define SUN6I_DPHY_ANA4_REG_TMSD(n) (((n) & 3) << 8) |
| #define SUN6I_DPHY_ANA4_REG_TXDNSC(n) (((n) & 3) << 6) |
| #define SUN6I_DPHY_ANA4_REG_TXDNSD(n) (((n) & 3) << 4) |
| #define SUN6I_DPHY_ANA4_REG_TXPUSC(n) (((n) & 3) << 2) |
| #define SUN6I_DPHY_ANA4_REG_TXPUSD(n) ((n) & 3) |
| |
| #define SUN6I_DPHY_DBG5_REG 0xf4 |
| |
| struct sun6i_dphy { |
| struct clk *bus_clk; |
| struct clk *mod_clk; |
| struct regmap *regs; |
| struct reset_control *reset; |
| |
| struct phy *phy; |
| struct phy_configure_opts_mipi_dphy config; |
| }; |
| |
| static int sun6i_dphy_init(struct phy *phy) |
| { |
| struct sun6i_dphy *dphy = phy_get_drvdata(phy); |
| |
| reset_control_deassert(dphy->reset); |
| clk_prepare_enable(dphy->mod_clk); |
| clk_set_rate_exclusive(dphy->mod_clk, 150000000); |
| |
| return 0; |
| } |
| |
| static int sun6i_dphy_configure(struct phy *phy, union phy_configure_opts *opts) |
| { |
| struct sun6i_dphy *dphy = phy_get_drvdata(phy); |
| int ret; |
| |
| ret = phy_mipi_dphy_config_validate(&opts->mipi_dphy); |
| if (ret) |
| return ret; |
| |
| memcpy(&dphy->config, opts, sizeof(dphy->config)); |
| |
| return 0; |
| } |
| |
| static int sun6i_dphy_power_on(struct phy *phy) |
| { |
| struct sun6i_dphy *dphy = phy_get_drvdata(phy); |
| u8 lanes_mask = GENMASK(dphy->config.lanes - 1, 0); |
| |
| regmap_write(dphy->regs, SUN6I_DPHY_TX_CTL_REG, |
| SUN6I_DPHY_TX_CTL_HS_TX_CLK_CONT); |
| |
| regmap_write(dphy->regs, SUN6I_DPHY_TX_TIME0_REG, |
| SUN6I_DPHY_TX_TIME0_LP_CLK_DIV(14) | |
| SUN6I_DPHY_TX_TIME0_HS_PREPARE(6) | |
| SUN6I_DPHY_TX_TIME0_HS_TRAIL(10)); |
| |
| regmap_write(dphy->regs, SUN6I_DPHY_TX_TIME1_REG, |
| SUN6I_DPHY_TX_TIME1_CLK_PREPARE(7) | |
| SUN6I_DPHY_TX_TIME1_CLK_ZERO(50) | |
| SUN6I_DPHY_TX_TIME1_CLK_PRE(3) | |
| SUN6I_DPHY_TX_TIME1_CLK_POST(10)); |
| |
| regmap_write(dphy->regs, SUN6I_DPHY_TX_TIME2_REG, |
| SUN6I_DPHY_TX_TIME2_CLK_TRAIL(30)); |
| |
| regmap_write(dphy->regs, SUN6I_DPHY_TX_TIME3_REG, 0); |
| |
| regmap_write(dphy->regs, SUN6I_DPHY_TX_TIME4_REG, |
| SUN6I_DPHY_TX_TIME4_HS_TX_ANA0(3) | |
| SUN6I_DPHY_TX_TIME4_HS_TX_ANA1(3)); |
| |
| regmap_write(dphy->regs, SUN6I_DPHY_GCTL_REG, |
| SUN6I_DPHY_GCTL_LANE_NUM(dphy->config.lanes) | |
| SUN6I_DPHY_GCTL_EN); |
| |
| regmap_write(dphy->regs, SUN6I_DPHY_ANA0_REG, |
| SUN6I_DPHY_ANA0_REG_PWS | |
| SUN6I_DPHY_ANA0_REG_DMPC | |
| SUN6I_DPHY_ANA0_REG_SLV(7) | |
| SUN6I_DPHY_ANA0_REG_DMPD(lanes_mask) | |
| SUN6I_DPHY_ANA0_REG_DEN(lanes_mask)); |
| |
| regmap_write(dphy->regs, SUN6I_DPHY_ANA1_REG, |
| SUN6I_DPHY_ANA1_REG_CSMPS(1) | |
| SUN6I_DPHY_ANA1_REG_SVTT(7)); |
| |
| regmap_write(dphy->regs, SUN6I_DPHY_ANA4_REG, |
| SUN6I_DPHY_ANA4_REG_CKDV(1) | |
| SUN6I_DPHY_ANA4_REG_TMSC(1) | |
| SUN6I_DPHY_ANA4_REG_TMSD(1) | |
| SUN6I_DPHY_ANA4_REG_TXDNSC(1) | |
| SUN6I_DPHY_ANA4_REG_TXDNSD(1) | |
| SUN6I_DPHY_ANA4_REG_TXPUSC(1) | |
| SUN6I_DPHY_ANA4_REG_TXPUSD(1) | |
| SUN6I_DPHY_ANA4_REG_DMPLVC | |
| SUN6I_DPHY_ANA4_REG_DMPLVD(lanes_mask)); |
| |
| regmap_write(dphy->regs, SUN6I_DPHY_ANA2_REG, |
| SUN6I_DPHY_ANA2_REG_ENIB); |
| udelay(5); |
| |
| regmap_write(dphy->regs, SUN6I_DPHY_ANA3_REG, |
| SUN6I_DPHY_ANA3_EN_LDOR | |
| SUN6I_DPHY_ANA3_EN_LDOC | |
| SUN6I_DPHY_ANA3_EN_LDOD); |
| udelay(1); |
| |
| regmap_update_bits(dphy->regs, SUN6I_DPHY_ANA3_REG, |
| SUN6I_DPHY_ANA3_EN_VTTC | |
| SUN6I_DPHY_ANA3_EN_VTTD_MASK, |
| SUN6I_DPHY_ANA3_EN_VTTC | |
| SUN6I_DPHY_ANA3_EN_VTTD(lanes_mask)); |
| udelay(1); |
| |
| regmap_update_bits(dphy->regs, SUN6I_DPHY_ANA3_REG, |
| SUN6I_DPHY_ANA3_EN_DIV, |
| SUN6I_DPHY_ANA3_EN_DIV); |
| udelay(1); |
| |
| regmap_update_bits(dphy->regs, SUN6I_DPHY_ANA2_REG, |
| SUN6I_DPHY_ANA2_EN_CK_CPU, |
| SUN6I_DPHY_ANA2_EN_CK_CPU); |
| udelay(1); |
| |
| regmap_update_bits(dphy->regs, SUN6I_DPHY_ANA1_REG, |
| SUN6I_DPHY_ANA1_REG_VTTMODE, |
| SUN6I_DPHY_ANA1_REG_VTTMODE); |
| |
| regmap_update_bits(dphy->regs, SUN6I_DPHY_ANA2_REG, |
| SUN6I_DPHY_ANA2_EN_P2S_CPU_MASK, |
| SUN6I_DPHY_ANA2_EN_P2S_CPU(lanes_mask)); |
| |
| return 0; |
| } |
| |
| static int sun6i_dphy_power_off(struct phy *phy) |
| { |
| struct sun6i_dphy *dphy = phy_get_drvdata(phy); |
| |
| regmap_update_bits(dphy->regs, SUN6I_DPHY_ANA1_REG, |
| SUN6I_DPHY_ANA1_REG_VTTMODE, 0); |
| |
| return 0; |
| } |
| |
| static int sun6i_dphy_exit(struct phy *phy) |
| { |
| struct sun6i_dphy *dphy = phy_get_drvdata(phy); |
| |
| clk_rate_exclusive_put(dphy->mod_clk); |
| clk_disable_unprepare(dphy->mod_clk); |
| reset_control_assert(dphy->reset); |
| |
| return 0; |
| } |
| |
| |
| static struct phy_ops sun6i_dphy_ops = { |
| .configure = sun6i_dphy_configure, |
| .power_on = sun6i_dphy_power_on, |
| .power_off = sun6i_dphy_power_off, |
| .init = sun6i_dphy_init, |
| .exit = sun6i_dphy_exit, |
| }; |
| |
| static struct regmap_config sun6i_dphy_regmap_config = { |
| .reg_bits = 32, |
| .val_bits = 32, |
| .reg_stride = 4, |
| .max_register = SUN6I_DPHY_DBG5_REG, |
| .name = "mipi-dphy", |
| }; |
| |
| static int sun6i_dphy_probe(struct platform_device *pdev) |
| { |
| struct phy_provider *phy_provider; |
| struct sun6i_dphy *dphy; |
| struct resource *res; |
| void __iomem *regs; |
| |
| dphy = devm_kzalloc(&pdev->dev, sizeof(*dphy), GFP_KERNEL); |
| if (!dphy) |
| return -ENOMEM; |
| |
| res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
| regs = devm_ioremap_resource(&pdev->dev, res); |
| if (IS_ERR(regs)) { |
| dev_err(&pdev->dev, "Couldn't map the DPHY encoder registers\n"); |
| return PTR_ERR(regs); |
| } |
| |
| dphy->regs = devm_regmap_init_mmio_clk(&pdev->dev, "bus", |
| regs, &sun6i_dphy_regmap_config); |
| if (IS_ERR(dphy->regs)) { |
| dev_err(&pdev->dev, "Couldn't create the DPHY encoder regmap\n"); |
| return PTR_ERR(dphy->regs); |
| } |
| |
| dphy->reset = devm_reset_control_get_shared(&pdev->dev, NULL); |
| if (IS_ERR(dphy->reset)) { |
| dev_err(&pdev->dev, "Couldn't get our reset line\n"); |
| return PTR_ERR(dphy->reset); |
| } |
| |
| dphy->mod_clk = devm_clk_get(&pdev->dev, "mod"); |
| if (IS_ERR(dphy->mod_clk)) { |
| dev_err(&pdev->dev, "Couldn't get the DPHY mod clock\n"); |
| return PTR_ERR(dphy->mod_clk); |
| } |
| |
| dphy->phy = devm_phy_create(&pdev->dev, NULL, &sun6i_dphy_ops); |
| if (IS_ERR(dphy->phy)) { |
| dev_err(&pdev->dev, "failed to create PHY\n"); |
| return PTR_ERR(dphy->phy); |
| } |
| |
| phy_set_drvdata(dphy->phy, dphy); |
| phy_provider = devm_of_phy_provider_register(&pdev->dev, of_phy_simple_xlate); |
| |
| return PTR_ERR_OR_ZERO(phy_provider); |
| } |
| |
| static const struct of_device_id sun6i_dphy_of_table[] = { |
| { .compatible = "allwinner,sun6i-a31-mipi-dphy" }, |
| { } |
| }; |
| MODULE_DEVICE_TABLE(of, sun6i_dphy_of_table); |
| |
| static struct platform_driver sun6i_dphy_platform_driver = { |
| .probe = sun6i_dphy_probe, |
| .driver = { |
| .name = "sun6i-mipi-dphy", |
| .of_match_table = sun6i_dphy_of_table, |
| }, |
| }; |
| module_platform_driver(sun6i_dphy_platform_driver); |
| |
| MODULE_AUTHOR("Maxime Ripard <maxime.ripard@bootlin>"); |
| MODULE_DESCRIPTION("Allwinner A31 MIPI D-PHY Driver"); |
| MODULE_LICENSE("GPL"); |