Linux Audio

Check our new training course

Loading...
v4.6
 
  1/*
  2 * Copyright (c) 2014, Fuzhou Rockchip Electronics Co., Ltd
  3 *
  4 * This program is free software; you can redistribute it and/or modify
  5 * it under the terms of the GNU General Public License as published by
  6 * the Free Software Foundation; either version 2 of the License, or
  7 * (at your option) any later version.
  8 */
  9
 
 
 10#include <linux/module.h>
 11#include <linux/platform_device.h>
 12#include <linux/mfd/syscon.h>
 13#include <linux/regmap.h>
 14#include <drm/drm_of.h>
 15#include <drm/drmP.h>
 16#include <drm/drm_crtc_helper.h>
 17#include <drm/drm_edid.h>
 18#include <drm/drm_encoder_slave.h>
 19#include <drm/bridge/dw_hdmi.h>
 
 
 
 
 20
 21#include "rockchip_drm_drv.h"
 22#include "rockchip_drm_vop.h"
 23
 24#define GRF_SOC_CON6                    0x025c
 25#define HDMI_SEL_VOP_LIT                (1 << 4)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 26
 27struct rockchip_hdmi {
 28	struct device *dev;
 29	struct regmap *regmap;
 30	struct drm_encoder encoder;
 
 
 
 
 
 
 
 31};
 32
 33#define to_rockchip_hdmi(x)	container_of(x, struct rockchip_hdmi, x)
 
 
 
 
 
 34
 35static const struct dw_hdmi_mpll_config rockchip_mpll_cfg[] = {
 36	{
 37		27000000, {
 38			{ 0x00b3, 0x0000},
 39			{ 0x2153, 0x0000},
 40			{ 0x40f3, 0x0000}
 41		},
 42	}, {
 43		36000000, {
 44			{ 0x00b3, 0x0000},
 45			{ 0x2153, 0x0000},
 46			{ 0x40f3, 0x0000}
 47		},
 48	}, {
 49		40000000, {
 50			{ 0x00b3, 0x0000},
 51			{ 0x2153, 0x0000},
 52			{ 0x40f3, 0x0000}
 53		},
 54	}, {
 55		54000000, {
 56			{ 0x0072, 0x0001},
 57			{ 0x2142, 0x0001},
 58			{ 0x40a2, 0x0001},
 59		},
 60	}, {
 61		65000000, {
 62			{ 0x0072, 0x0001},
 63			{ 0x2142, 0x0001},
 64			{ 0x40a2, 0x0001},
 65		},
 66	}, {
 67		66000000, {
 68			{ 0x013e, 0x0003},
 69			{ 0x217e, 0x0002},
 70			{ 0x4061, 0x0002}
 71		},
 72	}, {
 73		74250000, {
 74			{ 0x0072, 0x0001},
 75			{ 0x2145, 0x0002},
 76			{ 0x4061, 0x0002}
 77		},
 78	}, {
 79		83500000, {
 80			{ 0x0072, 0x0001},
 81		},
 82	}, {
 83		108000000, {
 84			{ 0x0051, 0x0002},
 85			{ 0x2145, 0x0002},
 86			{ 0x4061, 0x0002}
 87		},
 88	}, {
 89		106500000, {
 90			{ 0x0051, 0x0002},
 91			{ 0x2145, 0x0002},
 92			{ 0x4061, 0x0002}
 93		},
 94	}, {
 95		146250000, {
 96			{ 0x0051, 0x0002},
 97			{ 0x2145, 0x0002},
 98			{ 0x4061, 0x0002}
 99		},
100	}, {
101		148500000, {
102			{ 0x0051, 0x0003},
103			{ 0x214c, 0x0003},
104			{ 0x4064, 0x0003}
105		},
106	}, {
107		~0UL, {
108			{ 0x00a0, 0x000a },
109			{ 0x2001, 0x000f },
110			{ 0x4002, 0x000f },
111		},
112	}
113};
114
115static const struct dw_hdmi_curr_ctrl rockchip_cur_ctr[] = {
116	/*      pixelclk    bpp8    bpp10   bpp12 */
117	{
118		40000000,  { 0x0018, 0x0018, 0x0018 },
119	}, {
120		65000000,  { 0x0028, 0x0028, 0x0028 },
121	}, {
122		66000000,  { 0x0038, 0x0038, 0x0038 },
123	}, {
124		74250000,  { 0x0028, 0x0038, 0x0038 },
125	}, {
126		83500000,  { 0x0028, 0x0038, 0x0038 },
127	}, {
128		146250000, { 0x0038, 0x0038, 0x0038 },
129	}, {
130		148500000, { 0x0000, 0x0038, 0x0038 },
131	}, {
132		~0UL,      { 0x0000, 0x0000, 0x0000},
133	}
134};
135
136static const struct dw_hdmi_phy_config rockchip_phy_config[] = {
137	/*pixelclk   symbol   term   vlev*/
138	{ 74250000,  0x8009, 0x0004, 0x0272},
139	{ 148500000, 0x802b, 0x0004, 0x028d},
140	{ 297000000, 0x8039, 0x0005, 0x028d},
141	{ ~0UL,	     0x0000, 0x0000, 0x0000}
142};
143
144static int rockchip_hdmi_parse_dt(struct rockchip_hdmi *hdmi)
145{
146	struct device_node *np = hdmi->dev->of_node;
147
148	hdmi->regmap = syscon_regmap_lookup_by_phandle(np, "rockchip,grf");
149	if (IS_ERR(hdmi->regmap)) {
150		dev_err(hdmi->dev, "Unable to get rockchip,grf\n");
151		return PTR_ERR(hdmi->regmap);
152	}
153
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
154	return 0;
155}
156
157static enum drm_mode_status
158dw_hdmi_rockchip_mode_valid(struct drm_connector *connector,
159			    struct drm_display_mode *mode)
 
160{
161	const struct dw_hdmi_mpll_config *mpll_cfg = rockchip_mpll_cfg;
162	int pclk = mode->clock * 1000;
163	bool valid = false;
164	int i;
165
166	for (i = 0; mpll_cfg[i].mpixelclock != (~0UL); i++) {
167		if (pclk == mpll_cfg[i].mpixelclock) {
168			valid = true;
169			break;
170		}
171	}
172
173	return (valid) ? MODE_OK : MODE_BAD;
174}
175
176static const struct drm_encoder_funcs dw_hdmi_rockchip_encoder_funcs = {
177	.destroy = drm_encoder_cleanup,
178};
179
180static void dw_hdmi_rockchip_encoder_disable(struct drm_encoder *encoder)
181{
182}
183
184static bool
185dw_hdmi_rockchip_encoder_mode_fixup(struct drm_encoder *encoder,
186				    const struct drm_display_mode *mode,
187				    struct drm_display_mode *adj_mode)
188{
189	return true;
190}
191
192static void dw_hdmi_rockchip_encoder_mode_set(struct drm_encoder *encoder,
193					      struct drm_display_mode *mode,
194					      struct drm_display_mode *adj_mode)
195{
 
 
 
196}
197
198static void dw_hdmi_rockchip_encoder_enable(struct drm_encoder *encoder)
199{
200	struct rockchip_hdmi *hdmi = to_rockchip_hdmi(encoder);
201	u32 val;
202	int mux;
203
204	rockchip_drm_crtc_mode_config(encoder->crtc, DRM_MODE_CONNECTOR_HDMIA,
205				      ROCKCHIP_OUT_MODE_AAAA);
206
207	mux = drm_of_encoder_active_endpoint_id(hdmi->dev->of_node, encoder);
208	if (mux)
209		val = HDMI_SEL_VOP_LIT | (HDMI_SEL_VOP_LIT << 16);
210	else
211		val = HDMI_SEL_VOP_LIT << 16;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
212
213	regmap_write(hdmi->regmap, GRF_SOC_CON6, val);
214	dev_dbg(hdmi->dev, "vop %s output to hdmi\n",
215		(mux) ? "LIT" : "BIG");
216}
217
218static const struct drm_encoder_helper_funcs dw_hdmi_rockchip_encoder_helper_funcs = {
219	.mode_fixup = dw_hdmi_rockchip_encoder_mode_fixup,
220	.mode_set   = dw_hdmi_rockchip_encoder_mode_set,
221	.enable     = dw_hdmi_rockchip_encoder_enable,
222	.disable    = dw_hdmi_rockchip_encoder_disable,
 
223};
224
225static const struct dw_hdmi_plat_data rockchip_hdmi_drv_data = {
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
226	.mode_valid = dw_hdmi_rockchip_mode_valid,
227	.mpll_cfg   = rockchip_mpll_cfg,
228	.cur_ctr    = rockchip_cur_ctr,
229	.phy_config = rockchip_phy_config,
230	.dev_type   = RK3288_HDMI,
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
231};
232
233static const struct of_device_id dw_hdmi_rockchip_dt_ids[] = {
 
 
 
234	{ .compatible = "rockchip,rk3288-dw-hdmi",
235	  .data = &rockchip_hdmi_drv_data
 
 
 
 
 
 
 
 
 
236	},
237	{},
238};
239MODULE_DEVICE_TABLE(of, dw_hdmi_rockchip_dt_ids);
240
241static int dw_hdmi_rockchip_bind(struct device *dev, struct device *master,
242				 void *data)
243{
244	struct platform_device *pdev = to_platform_device(dev);
245	const struct dw_hdmi_plat_data *plat_data;
246	const struct of_device_id *match;
247	struct drm_device *drm = data;
248	struct drm_encoder *encoder;
249	struct rockchip_hdmi *hdmi;
250	struct resource *iores;
251	int irq;
252	int ret;
253
254	if (!pdev->dev.of_node)
255		return -ENODEV;
256
257	hdmi = devm_kzalloc(&pdev->dev, sizeof(*hdmi), GFP_KERNEL);
258	if (!hdmi)
259		return -ENOMEM;
260
261	match = of_match_node(dw_hdmi_rockchip_dt_ids, pdev->dev.of_node);
262	plat_data = match->data;
263	hdmi->dev = &pdev->dev;
264	encoder = &hdmi->encoder;
 
265
266	irq = platform_get_irq(pdev, 0);
267	if (irq < 0)
268		return irq;
269
270	iores = platform_get_resource(pdev, IORESOURCE_MEM, 0);
271	if (!iores)
272		return -ENXIO;
273
274	encoder->possible_crtcs = drm_of_find_possible_crtcs(drm, dev->of_node);
 
 
 
275	/*
276	 * If we failed to find the CRTC(s) which this encoder is
277	 * supposed to be connected to, it's because the CRTC has
278	 * not been registered yet.  Defer probing, and hope that
279	 * the required CRTC is added later.
280	 */
281	if (encoder->possible_crtcs == 0)
282		return -EPROBE_DEFER;
283
284	ret = rockchip_hdmi_parse_dt(hdmi);
285	if (ret) {
286		dev_err(hdmi->dev, "Unable to parse OF data\n");
 
 
 
 
 
 
 
 
 
287		return ret;
288	}
289
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
290	drm_encoder_helper_add(encoder, &dw_hdmi_rockchip_encoder_helper_funcs);
291	drm_encoder_init(drm, encoder, &dw_hdmi_rockchip_encoder_funcs,
292			 DRM_MODE_ENCODER_TMDS, NULL);
 
293
294	ret = dw_hdmi_bind(dev, master, data, encoder, iores, irq, plat_data);
295
296	/*
297	 * If dw_hdmi_bind() fails we'll never call dw_hdmi_unbind(),
298	 * which would have called the encoder cleanup.  Do it manually.
299	 */
300	if (ret)
301		drm_encoder_cleanup(encoder);
 
 
 
 
302
 
 
 
 
 
 
 
 
303	return ret;
304}
305
306static void dw_hdmi_rockchip_unbind(struct device *dev, struct device *master,
307				    void *data)
308{
309	return dw_hdmi_unbind(dev, master, data);
 
 
 
 
 
 
310}
311
312static const struct component_ops dw_hdmi_rockchip_ops = {
313	.bind	= dw_hdmi_rockchip_bind,
314	.unbind	= dw_hdmi_rockchip_unbind,
315};
316
317static int dw_hdmi_rockchip_probe(struct platform_device *pdev)
318{
319	return component_add(&pdev->dev, &dw_hdmi_rockchip_ops);
320}
321
322static int dw_hdmi_rockchip_remove(struct platform_device *pdev)
323{
324	component_del(&pdev->dev, &dw_hdmi_rockchip_ops);
325
326	return 0;
327}
328
329static struct platform_driver dw_hdmi_rockchip_pltfm_driver = {
 
 
 
 
 
 
 
 
 
 
 
 
 
330	.probe  = dw_hdmi_rockchip_probe,
331	.remove = dw_hdmi_rockchip_remove,
332	.driver = {
333		.name = "dwhdmi-rockchip",
 
334		.of_match_table = dw_hdmi_rockchip_dt_ids,
335	},
336};
337
338module_platform_driver(dw_hdmi_rockchip_pltfm_driver);
339
340MODULE_AUTHOR("Andy Yan <andy.yan@rock-chips.com>");
341MODULE_AUTHOR("Yakir Yang <ykk@rock-chips.com>");
342MODULE_DESCRIPTION("Rockchip Specific DW-HDMI Driver Extension");
343MODULE_LICENSE("GPL");
344MODULE_ALIAS("platform:dwhdmi-rockchip");
v6.2
  1// SPDX-License-Identifier: GPL-2.0-or-later
  2/*
  3 * Copyright (c) 2014, Fuzhou Rockchip Electronics Co., Ltd
 
 
 
 
 
  4 */
  5
  6#include <linux/clk.h>
  7#include <linux/mfd/syscon.h>
  8#include <linux/module.h>
  9#include <linux/platform_device.h>
 10#include <linux/phy/phy.h>
 11#include <linux/regmap.h>
 12#include <linux/regulator/consumer.h>
 13
 
 
 
 14#include <drm/bridge/dw_hdmi.h>
 15#include <drm/drm_edid.h>
 16#include <drm/drm_of.h>
 17#include <drm/drm_probe_helper.h>
 18#include <drm/drm_simple_kms_helper.h>
 19
 20#include "rockchip_drm_drv.h"
 21#include "rockchip_drm_vop.h"
 22
 23#define RK3228_GRF_SOC_CON2		0x0408
 24#define RK3228_HDMI_SDAIN_MSK		BIT(14)
 25#define RK3228_HDMI_SCLIN_MSK		BIT(13)
 26#define RK3228_GRF_SOC_CON6		0x0418
 27#define RK3228_HDMI_HPD_VSEL		BIT(6)
 28#define RK3228_HDMI_SDA_VSEL		BIT(5)
 29#define RK3228_HDMI_SCL_VSEL		BIT(4)
 30
 31#define RK3288_GRF_SOC_CON6		0x025C
 32#define RK3288_HDMI_LCDC_SEL		BIT(4)
 33#define RK3328_GRF_SOC_CON2		0x0408
 34
 35#define RK3328_HDMI_SDAIN_MSK		BIT(11)
 36#define RK3328_HDMI_SCLIN_MSK		BIT(10)
 37#define RK3328_HDMI_HPD_IOE		BIT(2)
 38#define RK3328_GRF_SOC_CON3		0x040c
 39/* need to be unset if hdmi or i2c should control voltage */
 40#define RK3328_HDMI_SDA5V_GRF		BIT(15)
 41#define RK3328_HDMI_SCL5V_GRF		BIT(14)
 42#define RK3328_HDMI_HPD5V_GRF		BIT(13)
 43#define RK3328_HDMI_CEC5V_GRF		BIT(12)
 44#define RK3328_GRF_SOC_CON4		0x0410
 45#define RK3328_HDMI_HPD_SARADC		BIT(13)
 46#define RK3328_HDMI_CEC_5V		BIT(11)
 47#define RK3328_HDMI_SDA_5V		BIT(10)
 48#define RK3328_HDMI_SCL_5V		BIT(9)
 49#define RK3328_HDMI_HPD_5V		BIT(8)
 50
 51#define RK3399_GRF_SOC_CON20		0x6250
 52#define RK3399_HDMI_LCDC_SEL		BIT(6)
 53
 54#define RK3568_GRF_VO_CON1		0x0364
 55#define RK3568_HDMI_SDAIN_MSK		BIT(15)
 56#define RK3568_HDMI_SCLIN_MSK		BIT(14)
 57
 58#define HIWORD_UPDATE(val, mask)	(val | (mask) << 16)
 59
 60/**
 61 * struct rockchip_hdmi_chip_data - splite the grf setting of kind of chips
 62 * @lcdsel_grf_reg: grf register offset of lcdc select
 63 * @lcdsel_big: reg value of selecting vop big for HDMI
 64 * @lcdsel_lit: reg value of selecting vop little for HDMI
 65 */
 66struct rockchip_hdmi_chip_data {
 67	int	lcdsel_grf_reg;
 68	u32	lcdsel_big;
 69	u32	lcdsel_lit;
 70};
 71
 72struct rockchip_hdmi {
 73	struct device *dev;
 74	struct regmap *regmap;
 75	struct rockchip_encoder encoder;
 76	const struct rockchip_hdmi_chip_data *chip_data;
 77	struct clk *ref_clk;
 78	struct clk *grf_clk;
 79	struct dw_hdmi *hdmi;
 80	struct regulator *avdd_0v9;
 81	struct regulator *avdd_1v8;
 82	struct phy *phy;
 83};
 84
 85static struct rockchip_hdmi *to_rockchip_hdmi(struct drm_encoder *encoder)
 86{
 87	struct rockchip_encoder *rkencoder = to_rockchip_encoder(encoder);
 88
 89	return container_of(rkencoder, struct rockchip_hdmi, encoder);
 90}
 91
 92static const struct dw_hdmi_mpll_config rockchip_mpll_cfg[] = {
 93	{
 94		27000000, {
 95			{ 0x00b3, 0x0000},
 96			{ 0x2153, 0x0000},
 97			{ 0x40f3, 0x0000}
 98		},
 99	}, {
100		36000000, {
101			{ 0x00b3, 0x0000},
102			{ 0x2153, 0x0000},
103			{ 0x40f3, 0x0000}
104		},
105	}, {
106		40000000, {
107			{ 0x00b3, 0x0000},
108			{ 0x2153, 0x0000},
109			{ 0x40f3, 0x0000}
110		},
111	}, {
112		54000000, {
113			{ 0x0072, 0x0001},
114			{ 0x2142, 0x0001},
115			{ 0x40a2, 0x0001},
116		},
117	}, {
118		65000000, {
119			{ 0x0072, 0x0001},
120			{ 0x2142, 0x0001},
121			{ 0x40a2, 0x0001},
122		},
123	}, {
124		66000000, {
125			{ 0x013e, 0x0003},
126			{ 0x217e, 0x0002},
127			{ 0x4061, 0x0002}
128		},
129	}, {
130		74250000, {
131			{ 0x0072, 0x0001},
132			{ 0x2145, 0x0002},
133			{ 0x4061, 0x0002}
134		},
135	}, {
136		83500000, {
137			{ 0x0072, 0x0001},
138		},
139	}, {
140		108000000, {
141			{ 0x0051, 0x0002},
142			{ 0x2145, 0x0002},
143			{ 0x4061, 0x0002}
144		},
145	}, {
146		106500000, {
147			{ 0x0051, 0x0002},
148			{ 0x2145, 0x0002},
149			{ 0x4061, 0x0002}
150		},
151	}, {
152		146250000, {
153			{ 0x0051, 0x0002},
154			{ 0x2145, 0x0002},
155			{ 0x4061, 0x0002}
156		},
157	}, {
158		148500000, {
159			{ 0x0051, 0x0003},
160			{ 0x214c, 0x0003},
161			{ 0x4064, 0x0003}
162		},
163	}, {
164		~0UL, {
165			{ 0x00a0, 0x000a },
166			{ 0x2001, 0x000f },
167			{ 0x4002, 0x000f },
168		},
169	}
170};
171
172static const struct dw_hdmi_curr_ctrl rockchip_cur_ctr[] = {
173	/*      pixelclk    bpp8    bpp10   bpp12 */
174	{
175		40000000,  { 0x0018, 0x0018, 0x0018 },
176	}, {
177		65000000,  { 0x0028, 0x0028, 0x0028 },
178	}, {
179		66000000,  { 0x0038, 0x0038, 0x0038 },
180	}, {
181		74250000,  { 0x0028, 0x0038, 0x0038 },
182	}, {
183		83500000,  { 0x0028, 0x0038, 0x0038 },
184	}, {
185		146250000, { 0x0038, 0x0038, 0x0038 },
186	}, {
187		148500000, { 0x0000, 0x0038, 0x0038 },
188	}, {
189		~0UL,      { 0x0000, 0x0000, 0x0000},
190	}
191};
192
193static const struct dw_hdmi_phy_config rockchip_phy_config[] = {
194	/*pixelclk   symbol   term   vlev*/
195	{ 74250000,  0x8009, 0x0004, 0x0272},
196	{ 148500000, 0x802b, 0x0004, 0x028d},
197	{ 297000000, 0x8039, 0x0005, 0x028d},
198	{ ~0UL,	     0x0000, 0x0000, 0x0000}
199};
200
201static int rockchip_hdmi_parse_dt(struct rockchip_hdmi *hdmi)
202{
203	struct device_node *np = hdmi->dev->of_node;
204
205	hdmi->regmap = syscon_regmap_lookup_by_phandle(np, "rockchip,grf");
206	if (IS_ERR(hdmi->regmap)) {
207		DRM_DEV_ERROR(hdmi->dev, "Unable to get rockchip,grf\n");
208		return PTR_ERR(hdmi->regmap);
209	}
210
211	hdmi->ref_clk = devm_clk_get_optional(hdmi->dev, "ref");
212	if (!hdmi->ref_clk)
213		hdmi->ref_clk = devm_clk_get_optional(hdmi->dev, "vpll");
214
215	if (PTR_ERR(hdmi->ref_clk) == -EPROBE_DEFER) {
216		return -EPROBE_DEFER;
217	} else if (IS_ERR(hdmi->ref_clk)) {
218		DRM_DEV_ERROR(hdmi->dev, "failed to get reference clock\n");
219		return PTR_ERR(hdmi->ref_clk);
220	}
221
222	hdmi->grf_clk = devm_clk_get(hdmi->dev, "grf");
223	if (PTR_ERR(hdmi->grf_clk) == -ENOENT) {
224		hdmi->grf_clk = NULL;
225	} else if (PTR_ERR(hdmi->grf_clk) == -EPROBE_DEFER) {
226		return -EPROBE_DEFER;
227	} else if (IS_ERR(hdmi->grf_clk)) {
228		DRM_DEV_ERROR(hdmi->dev, "failed to get grf clock\n");
229		return PTR_ERR(hdmi->grf_clk);
230	}
231
232	hdmi->avdd_0v9 = devm_regulator_get(hdmi->dev, "avdd-0v9");
233	if (IS_ERR(hdmi->avdd_0v9))
234		return PTR_ERR(hdmi->avdd_0v9);
235
236	hdmi->avdd_1v8 = devm_regulator_get(hdmi->dev, "avdd-1v8");
237	if (IS_ERR(hdmi->avdd_1v8))
238		return PTR_ERR(hdmi->avdd_1v8);
239
240	return 0;
241}
242
243static enum drm_mode_status
244dw_hdmi_rockchip_mode_valid(struct dw_hdmi *hdmi, void *data,
245			    const struct drm_display_info *info,
246			    const struct drm_display_mode *mode)
247{
248	const struct dw_hdmi_mpll_config *mpll_cfg = rockchip_mpll_cfg;
249	int pclk = mode->clock * 1000;
250	bool valid = false;
251	int i;
252
253	for (i = 0; mpll_cfg[i].mpixelclock != (~0UL); i++) {
254		if (pclk == mpll_cfg[i].mpixelclock) {
255			valid = true;
256			break;
257		}
258	}
259
260	return (valid) ? MODE_OK : MODE_BAD;
261}
262
 
 
 
 
263static void dw_hdmi_rockchip_encoder_disable(struct drm_encoder *encoder)
264{
265}
266
267static bool
268dw_hdmi_rockchip_encoder_mode_fixup(struct drm_encoder *encoder,
269				    const struct drm_display_mode *mode,
270				    struct drm_display_mode *adj_mode)
271{
272	return true;
273}
274
275static void dw_hdmi_rockchip_encoder_mode_set(struct drm_encoder *encoder,
276					      struct drm_display_mode *mode,
277					      struct drm_display_mode *adj_mode)
278{
279	struct rockchip_hdmi *hdmi = to_rockchip_hdmi(encoder);
280
281	clk_set_rate(hdmi->ref_clk, adj_mode->clock * 1000);
282}
283
284static void dw_hdmi_rockchip_encoder_enable(struct drm_encoder *encoder)
285{
286	struct rockchip_hdmi *hdmi = to_rockchip_hdmi(encoder);
287	u32 val;
288	int ret;
289
290	if (hdmi->chip_data->lcdsel_grf_reg < 0)
291		return;
292
293	ret = drm_of_encoder_active_endpoint_id(hdmi->dev->of_node, encoder);
294	if (ret)
295		val = hdmi->chip_data->lcdsel_lit;
296	else
297		val = hdmi->chip_data->lcdsel_big;
298
299	ret = clk_prepare_enable(hdmi->grf_clk);
300	if (ret < 0) {
301		DRM_DEV_ERROR(hdmi->dev, "failed to enable grfclk %d\n", ret);
302		return;
303	}
304
305	ret = regmap_write(hdmi->regmap, hdmi->chip_data->lcdsel_grf_reg, val);
306	if (ret != 0)
307		DRM_DEV_ERROR(hdmi->dev, "Could not write to GRF: %d\n", ret);
308
309	clk_disable_unprepare(hdmi->grf_clk);
310	DRM_DEV_DEBUG(hdmi->dev, "vop %s output to hdmi\n",
311		      ret ? "LIT" : "BIG");
312}
313
314static int
315dw_hdmi_rockchip_encoder_atomic_check(struct drm_encoder *encoder,
316				      struct drm_crtc_state *crtc_state,
317				      struct drm_connector_state *conn_state)
318{
319	struct rockchip_crtc_state *s = to_rockchip_crtc_state(crtc_state);
320
321	s->output_mode = ROCKCHIP_OUT_MODE_AAAA;
322	s->output_type = DRM_MODE_CONNECTOR_HDMIA;
323
324	return 0;
 
 
325}
326
327static const struct drm_encoder_helper_funcs dw_hdmi_rockchip_encoder_helper_funcs = {
328	.mode_fixup = dw_hdmi_rockchip_encoder_mode_fixup,
329	.mode_set   = dw_hdmi_rockchip_encoder_mode_set,
330	.enable     = dw_hdmi_rockchip_encoder_enable,
331	.disable    = dw_hdmi_rockchip_encoder_disable,
332	.atomic_check = dw_hdmi_rockchip_encoder_atomic_check,
333};
334
335static int dw_hdmi_rockchip_genphy_init(struct dw_hdmi *dw_hdmi, void *data,
336					const struct drm_display_info *display,
337					const struct drm_display_mode *mode)
338{
339	struct rockchip_hdmi *hdmi = (struct rockchip_hdmi *)data;
340
341	return phy_power_on(hdmi->phy);
342}
343
344static void dw_hdmi_rockchip_genphy_disable(struct dw_hdmi *dw_hdmi, void *data)
345{
346	struct rockchip_hdmi *hdmi = (struct rockchip_hdmi *)data;
347
348	phy_power_off(hdmi->phy);
349}
350
351static void dw_hdmi_rk3228_setup_hpd(struct dw_hdmi *dw_hdmi, void *data)
352{
353	struct rockchip_hdmi *hdmi = (struct rockchip_hdmi *)data;
354
355	dw_hdmi_phy_setup_hpd(dw_hdmi, data);
356
357	regmap_write(hdmi->regmap,
358		RK3228_GRF_SOC_CON6,
359		HIWORD_UPDATE(RK3228_HDMI_HPD_VSEL | RK3228_HDMI_SDA_VSEL |
360			      RK3228_HDMI_SCL_VSEL,
361			      RK3228_HDMI_HPD_VSEL | RK3228_HDMI_SDA_VSEL |
362			      RK3228_HDMI_SCL_VSEL));
363
364	regmap_write(hdmi->regmap,
365		RK3228_GRF_SOC_CON2,
366		HIWORD_UPDATE(RK3228_HDMI_SDAIN_MSK | RK3228_HDMI_SCLIN_MSK,
367			      RK3228_HDMI_SDAIN_MSK | RK3228_HDMI_SCLIN_MSK));
368}
369
370static enum drm_connector_status
371dw_hdmi_rk3328_read_hpd(struct dw_hdmi *dw_hdmi, void *data)
372{
373	struct rockchip_hdmi *hdmi = (struct rockchip_hdmi *)data;
374	enum drm_connector_status status;
375
376	status = dw_hdmi_phy_read_hpd(dw_hdmi, data);
377
378	if (status == connector_status_connected)
379		regmap_write(hdmi->regmap,
380			RK3328_GRF_SOC_CON4,
381			HIWORD_UPDATE(RK3328_HDMI_SDA_5V | RK3328_HDMI_SCL_5V,
382				      RK3328_HDMI_SDA_5V | RK3328_HDMI_SCL_5V));
383	else
384		regmap_write(hdmi->regmap,
385			RK3328_GRF_SOC_CON4,
386			HIWORD_UPDATE(0, RK3328_HDMI_SDA_5V |
387					 RK3328_HDMI_SCL_5V));
388	return status;
389}
390
391static void dw_hdmi_rk3328_setup_hpd(struct dw_hdmi *dw_hdmi, void *data)
392{
393	struct rockchip_hdmi *hdmi = (struct rockchip_hdmi *)data;
394
395	dw_hdmi_phy_setup_hpd(dw_hdmi, data);
396
397	/* Enable and map pins to 3V grf-controlled io-voltage */
398	regmap_write(hdmi->regmap,
399		RK3328_GRF_SOC_CON4,
400		HIWORD_UPDATE(0, RK3328_HDMI_HPD_SARADC | RK3328_HDMI_CEC_5V |
401				 RK3328_HDMI_SDA_5V | RK3328_HDMI_SCL_5V |
402				 RK3328_HDMI_HPD_5V));
403	regmap_write(hdmi->regmap,
404		RK3328_GRF_SOC_CON3,
405		HIWORD_UPDATE(0, RK3328_HDMI_SDA5V_GRF | RK3328_HDMI_SCL5V_GRF |
406				 RK3328_HDMI_HPD5V_GRF |
407				 RK3328_HDMI_CEC5V_GRF));
408	regmap_write(hdmi->regmap,
409		RK3328_GRF_SOC_CON2,
410		HIWORD_UPDATE(RK3328_HDMI_SDAIN_MSK | RK3328_HDMI_SCLIN_MSK,
411			      RK3328_HDMI_SDAIN_MSK | RK3328_HDMI_SCLIN_MSK |
412			      RK3328_HDMI_HPD_IOE));
413}
414
415static const struct dw_hdmi_phy_ops rk3228_hdmi_phy_ops = {
416	.init		= dw_hdmi_rockchip_genphy_init,
417	.disable	= dw_hdmi_rockchip_genphy_disable,
418	.read_hpd	= dw_hdmi_phy_read_hpd,
419	.update_hpd	= dw_hdmi_phy_update_hpd,
420	.setup_hpd	= dw_hdmi_rk3228_setup_hpd,
421};
422
423static struct rockchip_hdmi_chip_data rk3228_chip_data = {
424	.lcdsel_grf_reg = -1,
425};
426
427static const struct dw_hdmi_plat_data rk3228_hdmi_drv_data = {
428	.mode_valid = dw_hdmi_rockchip_mode_valid,
429	.mpll_cfg = rockchip_mpll_cfg,
430	.cur_ctr = rockchip_cur_ctr,
431	.phy_config = rockchip_phy_config,
432	.phy_data = &rk3228_chip_data,
433	.phy_ops = &rk3228_hdmi_phy_ops,
434	.phy_name = "inno_dw_hdmi_phy2",
435	.phy_force_vendor = true,
436};
437
438static struct rockchip_hdmi_chip_data rk3288_chip_data = {
439	.lcdsel_grf_reg = RK3288_GRF_SOC_CON6,
440	.lcdsel_big = HIWORD_UPDATE(0, RK3288_HDMI_LCDC_SEL),
441	.lcdsel_lit = HIWORD_UPDATE(RK3288_HDMI_LCDC_SEL, RK3288_HDMI_LCDC_SEL),
442};
443
444static const struct dw_hdmi_plat_data rk3288_hdmi_drv_data = {
445	.mode_valid = dw_hdmi_rockchip_mode_valid,
446	.mpll_cfg   = rockchip_mpll_cfg,
447	.cur_ctr    = rockchip_cur_ctr,
448	.phy_config = rockchip_phy_config,
449	.phy_data = &rk3288_chip_data,
450};
451
452static const struct dw_hdmi_phy_ops rk3328_hdmi_phy_ops = {
453	.init		= dw_hdmi_rockchip_genphy_init,
454	.disable	= dw_hdmi_rockchip_genphy_disable,
455	.read_hpd	= dw_hdmi_rk3328_read_hpd,
456	.update_hpd	= dw_hdmi_phy_update_hpd,
457	.setup_hpd	= dw_hdmi_rk3328_setup_hpd,
458};
459
460static struct rockchip_hdmi_chip_data rk3328_chip_data = {
461	.lcdsel_grf_reg = -1,
462};
463
464static const struct dw_hdmi_plat_data rk3328_hdmi_drv_data = {
465	.mode_valid = dw_hdmi_rockchip_mode_valid,
466	.mpll_cfg = rockchip_mpll_cfg,
467	.cur_ctr = rockchip_cur_ctr,
468	.phy_config = rockchip_phy_config,
469	.phy_data = &rk3328_chip_data,
470	.phy_ops = &rk3328_hdmi_phy_ops,
471	.phy_name = "inno_dw_hdmi_phy2",
472	.phy_force_vendor = true,
473	.use_drm_infoframe = true,
474};
475
476static struct rockchip_hdmi_chip_data rk3399_chip_data = {
477	.lcdsel_grf_reg = RK3399_GRF_SOC_CON20,
478	.lcdsel_big = HIWORD_UPDATE(0, RK3399_HDMI_LCDC_SEL),
479	.lcdsel_lit = HIWORD_UPDATE(RK3399_HDMI_LCDC_SEL, RK3399_HDMI_LCDC_SEL),
480};
481
482static const struct dw_hdmi_plat_data rk3399_hdmi_drv_data = {
483	.mode_valid = dw_hdmi_rockchip_mode_valid,
484	.mpll_cfg   = rockchip_mpll_cfg,
485	.cur_ctr    = rockchip_cur_ctr,
486	.phy_config = rockchip_phy_config,
487	.phy_data = &rk3399_chip_data,
488	.use_drm_infoframe = true,
489};
490
491static struct rockchip_hdmi_chip_data rk3568_chip_data = {
492	.lcdsel_grf_reg = -1,
493};
494
495static const struct dw_hdmi_plat_data rk3568_hdmi_drv_data = {
496	.mode_valid = dw_hdmi_rockchip_mode_valid,
497	.mpll_cfg   = rockchip_mpll_cfg,
498	.cur_ctr    = rockchip_cur_ctr,
499	.phy_config = rockchip_phy_config,
500	.phy_data = &rk3568_chip_data,
501	.use_drm_infoframe = true,
502};
503
504static const struct of_device_id dw_hdmi_rockchip_dt_ids[] = {
505	{ .compatible = "rockchip,rk3228-dw-hdmi",
506	  .data = &rk3228_hdmi_drv_data
507	},
508	{ .compatible = "rockchip,rk3288-dw-hdmi",
509	  .data = &rk3288_hdmi_drv_data
510	},
511	{ .compatible = "rockchip,rk3328-dw-hdmi",
512	  .data = &rk3328_hdmi_drv_data
513	},
514	{ .compatible = "rockchip,rk3399-dw-hdmi",
515	  .data = &rk3399_hdmi_drv_data
516	},
517	{ .compatible = "rockchip,rk3568-dw-hdmi",
518	  .data = &rk3568_hdmi_drv_data
519	},
520	{},
521};
522MODULE_DEVICE_TABLE(of, dw_hdmi_rockchip_dt_ids);
523
524static int dw_hdmi_rockchip_bind(struct device *dev, struct device *master,
525				 void *data)
526{
527	struct platform_device *pdev = to_platform_device(dev);
528	struct dw_hdmi_plat_data *plat_data;
529	const struct of_device_id *match;
530	struct drm_device *drm = data;
531	struct drm_encoder *encoder;
532	struct rockchip_hdmi *hdmi;
 
 
533	int ret;
534
535	if (!pdev->dev.of_node)
536		return -ENODEV;
537
538	hdmi = devm_kzalloc(&pdev->dev, sizeof(*hdmi), GFP_KERNEL);
539	if (!hdmi)
540		return -ENOMEM;
541
542	match = of_match_node(dw_hdmi_rockchip_dt_ids, pdev->dev.of_node);
543	plat_data = devm_kmemdup(&pdev->dev, match->data,
544					     sizeof(*plat_data), GFP_KERNEL);
545	if (!plat_data)
546		return -ENOMEM;
547
548	hdmi->dev = &pdev->dev;
549	hdmi->chip_data = plat_data->phy_data;
550	plat_data->phy_data = hdmi;
551	encoder = &hdmi->encoder.encoder;
 
 
 
552
553	encoder->possible_crtcs = drm_of_find_possible_crtcs(drm, dev->of_node);
554	rockchip_drm_encoder_set_crtc_endpoint_id(&hdmi->encoder,
555						  dev->of_node, 0, 0);
556
557	/*
558	 * If we failed to find the CRTC(s) which this encoder is
559	 * supposed to be connected to, it's because the CRTC has
560	 * not been registered yet.  Defer probing, and hope that
561	 * the required CRTC is added later.
562	 */
563	if (encoder->possible_crtcs == 0)
564		return -EPROBE_DEFER;
565
566	ret = rockchip_hdmi_parse_dt(hdmi);
567	if (ret) {
568		if (ret != -EPROBE_DEFER)
569			DRM_DEV_ERROR(hdmi->dev, "Unable to parse OF data\n");
570		return ret;
571	}
572
573	hdmi->phy = devm_phy_optional_get(dev, "hdmi");
574	if (IS_ERR(hdmi->phy)) {
575		ret = PTR_ERR(hdmi->phy);
576		if (ret != -EPROBE_DEFER)
577			DRM_DEV_ERROR(hdmi->dev, "failed to get phy\n");
578		return ret;
579	}
580
581	ret = regulator_enable(hdmi->avdd_0v9);
582	if (ret) {
583		DRM_DEV_ERROR(hdmi->dev, "failed to enable avdd0v9: %d\n", ret);
584		goto err_avdd_0v9;
585	}
586
587	ret = regulator_enable(hdmi->avdd_1v8);
588	if (ret) {
589		DRM_DEV_ERROR(hdmi->dev, "failed to enable avdd1v8: %d\n", ret);
590		goto err_avdd_1v8;
591	}
592
593	ret = clk_prepare_enable(hdmi->ref_clk);
594	if (ret) {
595		DRM_DEV_ERROR(hdmi->dev, "Failed to enable HDMI reference clock: %d\n",
596			      ret);
597		goto err_clk;
598	}
599
600	if (hdmi->chip_data == &rk3568_chip_data) {
601		regmap_write(hdmi->regmap, RK3568_GRF_VO_CON1,
602			     HIWORD_UPDATE(RK3568_HDMI_SDAIN_MSK |
603					   RK3568_HDMI_SCLIN_MSK,
604					   RK3568_HDMI_SDAIN_MSK |
605					   RK3568_HDMI_SCLIN_MSK));
606	}
607
608	drm_encoder_helper_add(encoder, &dw_hdmi_rockchip_encoder_helper_funcs);
609	drm_simple_encoder_init(drm, encoder, DRM_MODE_ENCODER_TMDS);
610
611	platform_set_drvdata(pdev, hdmi);
612
613	hdmi->hdmi = dw_hdmi_bind(pdev, encoder, plat_data);
614
615	/*
616	 * If dw_hdmi_bind() fails we'll never call dw_hdmi_unbind(),
617	 * which would have called the encoder cleanup.  Do it manually.
618	 */
619	if (IS_ERR(hdmi->hdmi)) {
620		ret = PTR_ERR(hdmi->hdmi);
621		goto err_bind;
622	}
623
624	return 0;
625
626err_bind:
627	drm_encoder_cleanup(encoder);
628	clk_disable_unprepare(hdmi->ref_clk);
629err_clk:
630	regulator_disable(hdmi->avdd_1v8);
631err_avdd_1v8:
632	regulator_disable(hdmi->avdd_0v9);
633err_avdd_0v9:
634	return ret;
635}
636
637static void dw_hdmi_rockchip_unbind(struct device *dev, struct device *master,
638				    void *data)
639{
640	struct rockchip_hdmi *hdmi = dev_get_drvdata(dev);
641
642	dw_hdmi_unbind(hdmi->hdmi);
643	clk_disable_unprepare(hdmi->ref_clk);
644
645	regulator_disable(hdmi->avdd_1v8);
646	regulator_disable(hdmi->avdd_0v9);
647}
648
649static const struct component_ops dw_hdmi_rockchip_ops = {
650	.bind	= dw_hdmi_rockchip_bind,
651	.unbind	= dw_hdmi_rockchip_unbind,
652};
653
654static int dw_hdmi_rockchip_probe(struct platform_device *pdev)
655{
656	return component_add(&pdev->dev, &dw_hdmi_rockchip_ops);
657}
658
659static int dw_hdmi_rockchip_remove(struct platform_device *pdev)
660{
661	component_del(&pdev->dev, &dw_hdmi_rockchip_ops);
662
663	return 0;
664}
665
666static int __maybe_unused dw_hdmi_rockchip_resume(struct device *dev)
667{
668	struct rockchip_hdmi *hdmi = dev_get_drvdata(dev);
669
670	dw_hdmi_resume(hdmi->hdmi);
671
672	return 0;
673}
674
675static const struct dev_pm_ops dw_hdmi_rockchip_pm = {
676	SET_SYSTEM_SLEEP_PM_OPS(NULL, dw_hdmi_rockchip_resume)
677};
678
679struct platform_driver dw_hdmi_rockchip_pltfm_driver = {
680	.probe  = dw_hdmi_rockchip_probe,
681	.remove = dw_hdmi_rockchip_remove,
682	.driver = {
683		.name = "dwhdmi-rockchip",
684		.pm = &dw_hdmi_rockchip_pm,
685		.of_match_table = dw_hdmi_rockchip_dt_ids,
686	},
687};