1 /*
2  * Copyright © 2006-2011 Intel Corporation
3  *
4  * Permission is hereby granted, free of charge, to any person obtaining a
5  * copy of this software and associated documentation files (the "Software"),
6  * to deal in the Software without restriction, including without limitation
7  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8  * and/or sell copies of the Software, and to permit persons to whom the
9  * Software is furnished to do so, subject to the following conditions:
10  *
11  * The above copyright notice and this permission notice (including the next
12  * paragraph) shall be included in all copies or substantial portions of the
13  * Software.
14  *
15  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
16  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
17  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
18  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
19  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
20  * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
21  * DEALINGS IN THE SOFTWARE.
22  *
23  * Authors:
24  *	jim liu <jim.liu@intel.com>
25  */
26 
27 #include <linux/pm_runtime.h>
28 
29 #include <drm/drm.h>
30 #include <drm/drm_crtc.h>
31 #include <drm/drm_edid.h>
32 #include <drm/drm_simple_kms_helper.h>
33 
34 #include "cdv_device.h"
35 #include "psb_drv.h"
36 #include "psb_intel_drv.h"
37 #include "psb_intel_reg.h"
38 
39 /* hdmi control bits */
40 #define HDMI_NULL_PACKETS_DURING_VSYNC	(1 << 9)
41 #define HDMI_BORDER_ENABLE		(1 << 7)
42 #define HDMI_AUDIO_ENABLE		(1 << 6)
43 #define HDMI_VSYNC_ACTIVE_HIGH		(1 << 4)
44 #define HDMI_HSYNC_ACTIVE_HIGH		(1 << 3)
45 /* hdmi-b control bits */
46 #define	HDMIB_PIPE_B_SELECT		(1 << 30)
47 
48 
49 struct mid_intel_hdmi_priv {
50 	u32 hdmi_reg;
51 	u32 save_HDMIB;
52 	bool has_hdmi_sink;
53 	bool has_hdmi_audio;
54 	/* Should set this when detect hotplug */
55 	bool hdmi_device_connected;
56 	struct drm_device *dev;
57 };
58 
59 static void cdv_hdmi_mode_set(struct drm_encoder *encoder,
60 			struct drm_display_mode *mode,
61 			struct drm_display_mode *adjusted_mode)
62 {
63 	struct drm_device *dev = encoder->dev;
64 	struct gma_encoder *gma_encoder = to_gma_encoder(encoder);
65 	struct mid_intel_hdmi_priv *hdmi_priv = gma_encoder->dev_priv;
66 	u32 hdmib;
67 	struct drm_crtc *crtc = encoder->crtc;
68 	struct gma_crtc *gma_crtc = to_gma_crtc(crtc);
69 
70 	hdmib = (2 << 10);
71 
72 	if (adjusted_mode->flags & DRM_MODE_FLAG_PVSYNC)
73 		hdmib |= HDMI_VSYNC_ACTIVE_HIGH;
74 	if (adjusted_mode->flags & DRM_MODE_FLAG_PHSYNC)
75 		hdmib |= HDMI_HSYNC_ACTIVE_HIGH;
76 
77 	if (gma_crtc->pipe == 1)
78 		hdmib |= HDMIB_PIPE_B_SELECT;
79 
80 	if (hdmi_priv->has_hdmi_audio) {
81 		hdmib |= HDMI_AUDIO_ENABLE;
82 		hdmib |= HDMI_NULL_PACKETS_DURING_VSYNC;
83 	}
84 
85 	REG_WRITE(hdmi_priv->hdmi_reg, hdmib);
86 	REG_READ(hdmi_priv->hdmi_reg);
87 }
88 
89 static void cdv_hdmi_dpms(struct drm_encoder *encoder, int mode)
90 {
91 	struct drm_device *dev = encoder->dev;
92 	struct gma_encoder *gma_encoder = to_gma_encoder(encoder);
93 	struct mid_intel_hdmi_priv *hdmi_priv = gma_encoder->dev_priv;
94 	u32 hdmib;
95 
96 	hdmib = REG_READ(hdmi_priv->hdmi_reg);
97 
98 	if (mode != DRM_MODE_DPMS_ON)
99 		REG_WRITE(hdmi_priv->hdmi_reg, hdmib & ~HDMIB_PORT_EN);
100 	else
101 		REG_WRITE(hdmi_priv->hdmi_reg, hdmib | HDMIB_PORT_EN);
102 	REG_READ(hdmi_priv->hdmi_reg);
103 }
104 
105 static void cdv_hdmi_save(struct drm_connector *connector)
106 {
107 	struct drm_device *dev = connector->dev;
108 	struct gma_encoder *gma_encoder = gma_attached_encoder(connector);
109 	struct mid_intel_hdmi_priv *hdmi_priv = gma_encoder->dev_priv;
110 
111 	hdmi_priv->save_HDMIB = REG_READ(hdmi_priv->hdmi_reg);
112 }
113 
114 static void cdv_hdmi_restore(struct drm_connector *connector)
115 {
116 	struct drm_device *dev = connector->dev;
117 	struct gma_encoder *gma_encoder = gma_attached_encoder(connector);
118 	struct mid_intel_hdmi_priv *hdmi_priv = gma_encoder->dev_priv;
119 
120 	REG_WRITE(hdmi_priv->hdmi_reg, hdmi_priv->save_HDMIB);
121 	REG_READ(hdmi_priv->hdmi_reg);
122 }
123 
124 static enum drm_connector_status cdv_hdmi_detect(
125 				struct drm_connector *connector, bool force)
126 {
127 	struct gma_encoder *gma_encoder = gma_attached_encoder(connector);
128 	struct mid_intel_hdmi_priv *hdmi_priv = gma_encoder->dev_priv;
129 	struct edid *edid = NULL;
130 	enum drm_connector_status status = connector_status_disconnected;
131 
132 	edid = drm_get_edid(connector, connector->ddc);
133 
134 	hdmi_priv->has_hdmi_sink = false;
135 	hdmi_priv->has_hdmi_audio = false;
136 	if (edid) {
137 		if (edid->input & DRM_EDID_INPUT_DIGITAL) {
138 			status = connector_status_connected;
139 			hdmi_priv->has_hdmi_sink =
140 						drm_detect_hdmi_monitor(edid);
141 			hdmi_priv->has_hdmi_audio =
142 						drm_detect_monitor_audio(edid);
143 		}
144 		kfree(edid);
145 	}
146 	return status;
147 }
148 
149 static int cdv_hdmi_set_property(struct drm_connector *connector,
150 				       struct drm_property *property,
151 				       uint64_t value)
152 {
153 	struct drm_encoder *encoder = connector->encoder;
154 
155 	if (!strcmp(property->name, "scaling mode") && encoder) {
156 		struct gma_crtc *crtc = to_gma_crtc(encoder->crtc);
157 		bool centre;
158 		uint64_t curValue;
159 
160 		if (!crtc)
161 			return -1;
162 
163 		switch (value) {
164 		case DRM_MODE_SCALE_FULLSCREEN:
165 			break;
166 		case DRM_MODE_SCALE_NO_SCALE:
167 			break;
168 		case DRM_MODE_SCALE_ASPECT:
169 			break;
170 		default:
171 			return -1;
172 		}
173 
174 		if (drm_object_property_get_value(&connector->base,
175 							property, &curValue))
176 			return -1;
177 
178 		if (curValue == value)
179 			return 0;
180 
181 		if (drm_object_property_set_value(&connector->base,
182 							property, value))
183 			return -1;
184 
185 		centre = (curValue == DRM_MODE_SCALE_NO_SCALE) ||
186 			(value == DRM_MODE_SCALE_NO_SCALE);
187 
188 		if (crtc->saved_mode.hdisplay != 0 &&
189 		    crtc->saved_mode.vdisplay != 0) {
190 			if (centre) {
191 				if (!drm_crtc_helper_set_mode(encoder->crtc, &crtc->saved_mode,
192 					    encoder->crtc->x, encoder->crtc->y, encoder->crtc->primary->fb))
193 					return -1;
194 			} else {
195 				const struct drm_encoder_helper_funcs *helpers
196 						    = encoder->helper_private;
197 				helpers->mode_set(encoder, &crtc->saved_mode,
198 					     &crtc->saved_adjusted_mode);
199 			}
200 		}
201 	}
202 	return 0;
203 }
204 
205 /*
206  * Return the list of HDMI DDC modes if available.
207  */
208 static int cdv_hdmi_get_modes(struct drm_connector *connector)
209 {
210 	struct edid *edid = NULL;
211 	int ret = 0;
212 
213 	edid = drm_get_edid(connector, connector->ddc);
214 	if (edid) {
215 		drm_connector_update_edid_property(connector, edid);
216 		ret = drm_add_edid_modes(connector, edid);
217 		kfree(edid);
218 	}
219 	return ret;
220 }
221 
222 static enum drm_mode_status cdv_hdmi_mode_valid(struct drm_connector *connector,
223 				 struct drm_display_mode *mode)
224 {
225 	if (mode->clock > 165000)
226 		return MODE_CLOCK_HIGH;
227 	if (mode->clock < 20000)
228 		return MODE_CLOCK_HIGH;
229 
230 	/* just in case */
231 	if (mode->flags & DRM_MODE_FLAG_DBLSCAN)
232 		return MODE_NO_DBLESCAN;
233 
234 	/* just in case */
235 	if (mode->flags & DRM_MODE_FLAG_INTERLACE)
236 		return MODE_NO_INTERLACE;
237 
238 	return MODE_OK;
239 }
240 
241 static void cdv_hdmi_destroy(struct drm_connector *connector)
242 {
243 	struct gma_connector *gma_connector = to_gma_connector(connector);
244 	struct gma_i2c_chan *ddc_bus = to_gma_i2c_chan(connector->ddc);
245 
246 	gma_i2c_destroy(ddc_bus);
247 	drm_connector_cleanup(connector);
248 	kfree(gma_connector);
249 }
250 
251 static const struct drm_encoder_helper_funcs cdv_hdmi_helper_funcs = {
252 	.dpms = cdv_hdmi_dpms,
253 	.prepare = gma_encoder_prepare,
254 	.mode_set = cdv_hdmi_mode_set,
255 	.commit = gma_encoder_commit,
256 };
257 
258 static const struct drm_connector_helper_funcs
259 					cdv_hdmi_connector_helper_funcs = {
260 	.get_modes = cdv_hdmi_get_modes,
261 	.mode_valid = cdv_hdmi_mode_valid,
262 	.best_encoder = gma_best_encoder,
263 };
264 
265 static const struct drm_connector_funcs cdv_hdmi_connector_funcs = {
266 	.dpms = drm_helper_connector_dpms,
267 	.detect = cdv_hdmi_detect,
268 	.fill_modes = drm_helper_probe_single_connector_modes,
269 	.set_property = cdv_hdmi_set_property,
270 	.destroy = cdv_hdmi_destroy,
271 };
272 
273 void cdv_hdmi_init(struct drm_device *dev,
274 			struct psb_intel_mode_device *mode_dev, int reg)
275 {
276 	struct gma_encoder *gma_encoder;
277 	struct gma_connector *gma_connector;
278 	struct drm_connector *connector;
279 	struct mid_intel_hdmi_priv *hdmi_priv;
280 	struct gma_i2c_chan *ddc_bus;
281 	int ddc_reg;
282 	int ret;
283 
284 	gma_encoder = kzalloc(sizeof(struct gma_encoder), GFP_KERNEL);
285 	if (!gma_encoder)
286 		return;
287 
288 	gma_connector = kzalloc(sizeof(struct gma_connector), GFP_KERNEL);
289 	if (!gma_connector)
290 		goto err_free_encoder;
291 
292 	hdmi_priv = kzalloc(sizeof(struct mid_intel_hdmi_priv), GFP_KERNEL);
293 	if (!hdmi_priv)
294 		goto err_free_connector;
295 
296 	connector = &gma_connector->base;
297 	connector->polled = DRM_CONNECTOR_POLL_HPD;
298 	gma_connector->save = cdv_hdmi_save;
299 	gma_connector->restore = cdv_hdmi_restore;
300 
301 	switch (reg) {
302 	case SDVOB:
303 		ddc_reg = GPIOE;
304 		gma_encoder->ddi_select = DDI0_SELECT;
305 		break;
306 	case SDVOC:
307 		ddc_reg = GPIOD;
308 		gma_encoder->ddi_select = DDI1_SELECT;
309 		break;
310 	default:
311 		DRM_ERROR("unknown reg 0x%x for HDMI\n", reg);
312 		goto err_free_hdmi_priv;
313 	}
314 
315 	ddc_bus = gma_i2c_create(dev, ddc_reg,
316 				 (reg == SDVOB) ? "HDMIB" : "HDMIC");
317 	if (!ddc_bus) {
318 		dev_err(dev->dev, "No ddc adapter available!\n");
319 		goto err_free_hdmi_priv;
320 	}
321 
322 	ret = drm_connector_init_with_ddc(dev, connector,
323 					  &cdv_hdmi_connector_funcs,
324 					  DRM_MODE_CONNECTOR_DVID,
325 					  &ddc_bus->base);
326 	if (ret)
327 		goto err_ddc_destroy;
328 
329 	ret = drm_simple_encoder_init(dev, &gma_encoder->base,
330 				      DRM_MODE_ENCODER_TMDS);
331 	if (ret)
332 		goto err_connector_cleanup;
333 
334 	gma_connector_attach_encoder(gma_connector, gma_encoder);
335 	gma_encoder->type = INTEL_OUTPUT_HDMI;
336 	hdmi_priv->hdmi_reg = reg;
337 	hdmi_priv->has_hdmi_sink = false;
338 	gma_encoder->dev_priv = hdmi_priv;
339 
340 	drm_encoder_helper_add(&gma_encoder->base, &cdv_hdmi_helper_funcs);
341 	drm_connector_helper_add(connector,
342 				 &cdv_hdmi_connector_helper_funcs);
343 	connector->display_info.subpixel_order = SubPixelHorizontalRGB;
344 	connector->interlace_allowed = false;
345 	connector->doublescan_allowed = false;
346 
347 	drm_object_attach_property(&connector->base,
348 				      dev->mode_config.scaling_mode_property,
349 				      DRM_MODE_SCALE_FULLSCREEN);
350 
351 	hdmi_priv->dev = dev;
352 	return;
353 
354 err_connector_cleanup:
355 	drm_connector_cleanup(connector);
356 err_ddc_destroy:
357 	gma_i2c_destroy(ddc_bus);
358 err_free_hdmi_priv:
359 	kfree(hdmi_priv);
360 err_free_connector:
361 	kfree(gma_connector);
362 err_free_encoder:
363 	kfree(gma_encoder);
364 }
365