1// SPDX-License-Identifier: GPL-2.0-only
  2/*
  3 * Copyright (c) 2016, The Linux Foundation. All rights reserved.
  4 */
  5
  6#include <linux/of_device.h>
  7
  8#include "hdmi.h"
  9
 10static int msm_hdmi_phy_resource_init(struct hdmi_phy *phy)
 11{
 12	struct hdmi_phy_cfg *cfg = phy->cfg;
 13	struct device *dev = &phy->pdev->dev;
 14	int i, ret;
 15
 16	phy->regs = devm_kcalloc(dev, cfg->num_regs, sizeof(phy->regs[0]),
 17				 GFP_KERNEL);
 18	if (!phy->regs)
 19		return -ENOMEM;
 20
 21	phy->clks = devm_kcalloc(dev, cfg->num_clks, sizeof(phy->clks[0]),
 22				 GFP_KERNEL);
 23	if (!phy->clks)
 24		return -ENOMEM;
 25
 26	for (i = 0; i < cfg->num_regs; i++) {
 27		struct regulator *reg;
 28
 29		reg = devm_regulator_get(dev, cfg->reg_names[i]);
 30		if (IS_ERR(reg)) {
 31			ret = PTR_ERR(reg);
 32			if (ret != -EPROBE_DEFER) {
 33				DRM_DEV_ERROR(dev,
 34					      "failed to get phy regulator: %s (%d)\n",
 35					      cfg->reg_names[i], ret);
 36			}
 37
 38			return ret;
 39		}
 40
 41		phy->regs[i] = reg;
 42	}
 43
 44	for (i = 0; i < cfg->num_clks; i++) {
 45		struct clk *clk;
 46
 47		clk = msm_clk_get(phy->pdev, cfg->clk_names[i]);
 48		if (IS_ERR(clk)) {
 49			ret = PTR_ERR(clk);
 50			DRM_DEV_ERROR(dev, "failed to get phy clock: %s (%d)\n",
 51				cfg->clk_names[i], ret);
 52			return ret;
 53		}
 54
 55		phy->clks[i] = clk;
 56	}
 57
 58	return 0;
 59}
 60
 61int msm_hdmi_phy_resource_enable(struct hdmi_phy *phy)
 62{
 63	struct hdmi_phy_cfg *cfg = phy->cfg;
 64	struct device *dev = &phy->pdev->dev;
 65	int i, ret = 0;
 66
 67	pm_runtime_get_sync(dev);
 68
 69	for (i = 0; i < cfg->num_regs; i++) {
 70		ret = regulator_enable(phy->regs[i]);
 71		if (ret)
 72			DRM_DEV_ERROR(dev, "failed to enable regulator: %s (%d)\n",
 73				cfg->reg_names[i], ret);
 74	}
 75
 76	for (i = 0; i < cfg->num_clks; i++) {
 77		ret = clk_prepare_enable(phy->clks[i]);
 78		if (ret)
 79			DRM_DEV_ERROR(dev, "failed to enable clock: %s (%d)\n",
 80				cfg->clk_names[i], ret);
 81	}
 82
 83	return ret;
 84}
 85
 86void msm_hdmi_phy_resource_disable(struct hdmi_phy *phy)
 87{
 88	struct hdmi_phy_cfg *cfg = phy->cfg;
 89	struct device *dev = &phy->pdev->dev;
 90	int i;
 91
 92	for (i = cfg->num_clks - 1; i >= 0; i--)
 93		clk_disable_unprepare(phy->clks[i]);
 94
 95	for (i = cfg->num_regs - 1; i >= 0; i--)
 96		regulator_disable(phy->regs[i]);
 97
 98	pm_runtime_put_sync(dev);
 99}
100
101void msm_hdmi_phy_powerup(struct hdmi_phy *phy, unsigned long int pixclock)
102{
103	if (!phy || !phy->cfg->powerup)
104		return;
105
106	phy->cfg->powerup(phy, pixclock);
107}
108
109void msm_hdmi_phy_powerdown(struct hdmi_phy *phy)
110{
111	if (!phy || !phy->cfg->powerdown)
112		return;
113
114	phy->cfg->powerdown(phy);
115}
116
117static int msm_hdmi_phy_pll_init(struct platform_device *pdev,
118			     enum hdmi_phy_type type)
119{
120	int ret;
121
122	switch (type) {
123	case MSM_HDMI_PHY_8960:
124		ret = msm_hdmi_pll_8960_init(pdev);
125		break;
126	case MSM_HDMI_PHY_8996:
127		ret = msm_hdmi_pll_8996_init(pdev);
128		break;
129	/*
130	 * we don't have PLL support for these, don't report an error for now
131	 */
132	case MSM_HDMI_PHY_8x60:
133	case MSM_HDMI_PHY_8x74:
134	default:
135		ret = 0;
136		break;
137	}
138
139	return ret;
140}
141
142static int msm_hdmi_phy_probe(struct platform_device *pdev)
143{
144	struct device *dev = &pdev->dev;
145	struct hdmi_phy *phy;
146	int ret;
147
148	phy = devm_kzalloc(dev, sizeof(*phy), GFP_KERNEL);
149	if (!phy)
150		return -ENODEV;
151
152	phy->cfg = (struct hdmi_phy_cfg *)of_device_get_match_data(dev);
153	if (!phy->cfg)
154		return -ENODEV;
155
156	phy->mmio = msm_ioremap(pdev, "hdmi_phy", "HDMI_PHY");
157	if (IS_ERR(phy->mmio)) {
158		DRM_DEV_ERROR(dev, "%s: failed to map phy base\n", __func__);
159		return -ENOMEM;
160	}
161
162	phy->pdev = pdev;
163
164	ret = msm_hdmi_phy_resource_init(phy);
165	if (ret)
166		return ret;
167
168	pm_runtime_enable(&pdev->dev);
169
170	ret = msm_hdmi_phy_resource_enable(phy);
171	if (ret)
172		return ret;
173
174	ret = msm_hdmi_phy_pll_init(pdev, phy->cfg->type);
175	if (ret) {
176		DRM_DEV_ERROR(dev, "couldn't init PLL\n");
177		msm_hdmi_phy_resource_disable(phy);
178		return ret;
179	}
180
181	msm_hdmi_phy_resource_disable(phy);
182
183	platform_set_drvdata(pdev, phy);
184
185	return 0;
186}
187
188static int msm_hdmi_phy_remove(struct platform_device *pdev)
189{
190	pm_runtime_disable(&pdev->dev);
191
192	return 0;
193}
194
195static const struct of_device_id msm_hdmi_phy_dt_match[] = {
196	{ .compatible = "qcom,hdmi-phy-8660",
197	  .data = &msm_hdmi_phy_8x60_cfg },
198	{ .compatible = "qcom,hdmi-phy-8960",
199	  .data = &msm_hdmi_phy_8960_cfg },
200	{ .compatible = "qcom,hdmi-phy-8974",
201	  .data = &msm_hdmi_phy_8x74_cfg },
202	{ .compatible = "qcom,hdmi-phy-8084",
203	  .data = &msm_hdmi_phy_8x74_cfg },
204	{ .compatible = "qcom,hdmi-phy-8996",
205	  .data = &msm_hdmi_phy_8996_cfg },
206	{}
207};
208
209static struct platform_driver msm_hdmi_phy_platform_driver = {
210	.probe      = msm_hdmi_phy_probe,
211	.remove     = msm_hdmi_phy_remove,
212	.driver     = {
213		.name   = "msm_hdmi_phy",
214		.of_match_table = msm_hdmi_phy_dt_match,
215	},
216};
217
218void __init msm_hdmi_phy_driver_register(void)
219{
220	platform_driver_register(&msm_hdmi_phy_platform_driver);
221}
222
223void __exit msm_hdmi_phy_driver_unregister(void)
224{
225	platform_driver_unregister(&msm_hdmi_phy_platform_driver);
226}