phy/starfive/phy-jh7110-dphy-tx.c

3  * DPHY TX driver for the StarFive JH7110 SoC
19 #include <linux/phy/phy-mipi-dphy.h>
212 static void stf_dphy_hw_reset(struct stf_dphy *dphy, int assert)
218 	       dphy->topsys + STF_DPHY_APBIFSAIF_SYSCFG(100));
221 		rc = readl_poll_timeout_atomic(dphy->topsys +
227 			dev_err(dphy->dev, "MIPI dphy-tx # PLL Locked\n");
233 	struct stf_dphy *dphy = phy_get_drvdata(phy);
234 	const struct stf_dphy_info *info = dphy->info;
246 	tmp = readl(dphy->topsys + STF_DPHY_APBIFSAIF_SYSCFG(100));
249 	writel(tmp, dphy->topsys + STF_DPHY_APBIFSAIF_SYSCFG(100));
253 	       dphy->topsys + STF_DPHY_APBIFSAIF_SYSCFG(8));
261 	       dphy->topsys + STF_DPHY_APBIFSAIF_SYSCFG(12));
265 	       dphy->topsys + STF_DPHY_APBIFSAIF_SYSCFG(16));
275 	       dphy->topsys + STF_DPHY_APBIFSAIF_SYSCFG(0));
279 	       dphy->topsys + STF_DPHY_APBIFSAIF_SYSCFG(28));
285 	       dphy->topsys + STF_DPHY_APBIFSAIF_SYSCFG(24));
291 	       dphy->topsys + STF_DPHY_APBIFSAIF_SYSCFG(20));
294 	       dphy->topsys + STF_DPHY_APBIFSAIF_SYSCFG(40));
300 	       dphy->topsys + STF_DPHY_APBIFSAIF_SYSCFG(36));
306 	       dphy->topsys + STF_DPHY_APBIFSAIF_SYSCFG(32));
313 	struct stf_dphy *dphy = phy_get_drvdata(phy);
316 	stf_dphy_hw_reset(dphy, 1);
320 	       dphy->topsys + STF_DPHY_APBIFSAIF_SYSCFG(48));
323 	       dphy->topsys + STF_DPHY_APBIFSAIF_SYSCFG(44));
325 	ret = clk_prepare_enable(dphy->txesc_clk);
327 		dev_err(dphy->dev, "Failed to prepare/enable txesc_clk\n");
331 	ret = reset_control_deassert(dphy->sys_rst);
333 		dev_err(dphy->dev, "Failed to deassert sys_rst\n");
342 	struct stf_dphy *dphy = phy_get_drvdata(phy);
345 	ret = reset_control_assert(dphy->sys_rst);
347 		dev_err(dphy->dev, "Failed to assert sys_rst\n");
351 	clk_disable_unprepare(dphy->txesc_clk);
353 	stf_dphy_hw_reset(dphy, 0);
360 	struct stf_dphy *dphy = phy_get_drvdata(phy);
362 	return pm_runtime_resume_and_get(dphy->dev);
376 	struct stf_dphy *dphy = phy_get_drvdata(phy);
378 	return pm_runtime_put_sync(dphy->dev);
394 	struct stf_dphy *dphy;
396 	dphy = devm_kzalloc(&pdev->dev, sizeof(*dphy), GFP_KERNEL);
397 	if (!dphy)
400 	dphy->info = of_device_get_match_data(&pdev->dev);
402 	dphy->dev = &pdev->dev;
403 	dev_set_drvdata(&pdev->dev, dphy);
405 	dphy->topsys = devm_platform_ioremap_resource(pdev, 0);
406 	if (IS_ERR(dphy->topsys))
407 		return PTR_ERR(dphy->topsys);
411 	dphy->txesc_clk = devm_clk_get(&pdev->dev, "txesc");
412 	if (IS_ERR(dphy->txesc_clk))
413 		return dev_err_probe(&pdev->dev, PTR_ERR(dphy->txesc_clk),
416 	dphy->sys_rst = devm_reset_control_get_exclusive(&pdev->dev, "sys");
417 	if (IS_ERR(dphy->sys_rst))
418 		return dev_err_probe(&pdev->dev, PTR_ERR(dphy->sys_rst),
421 	dphy->phy = devm_phy_create(&pdev->dev, NULL, &stf_dphy_ops);
422 	if (IS_ERR(dphy->phy))
423 		return dev_err_probe(&pdev->dev, PTR_ERR(dphy->phy),
426 	phy_set_drvdata(dphy->phy, dphy);
442 		.compatible = "starfive,jh7110-dphy-tx",
451 		.name	= "starfive-dphy-tx",
460 MODULE_DESCRIPTION("StarFive JH7110 DPHY TX driver");