xref: /linux/drivers/gpu/drm/drm_fb_helper.c (revision 36239c6704b71da7fb8e2a9429e159a84d0c5a3e)
1 /*
2  * Copyright (c) 2006-2009 Red Hat Inc.
3  * Copyright (c) 2006-2008 Intel Corporation
4  * Copyright (c) 2007 Dave Airlie <airlied@linux.ie>
5  *
6  * DRM framebuffer helper functions
7  *
8  * Permission to use, copy, modify, distribute, and sell this software and its
9  * documentation for any purpose is hereby granted without fee, provided that
10  * the above copyright notice appear in all copies and that both that copyright
11  * notice and this permission notice appear in supporting documentation, and
12  * that the name of the copyright holders not be used in advertising or
13  * publicity pertaining to distribution of the software without specific,
14  * written prior permission.  The copyright holders make no representations
15  * about the suitability of this software for any purpose.  It is provided "as
16  * is" without express or implied warranty.
17  *
18  * THE COPYRIGHT HOLDERS DISCLAIM ALL WARRANTIES WITH REGARD TO THIS SOFTWARE,
19  * INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS, IN NO
20  * EVENT SHALL THE COPYRIGHT HOLDERS BE LIABLE FOR ANY SPECIAL, INDIRECT OR
21  * CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE,
22  * DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
23  * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE
24  * OF THIS SOFTWARE.
25  *
26  * Authors:
27  *      Dave Airlie <airlied@linux.ie>
28  *      Jesse Barnes <jesse.barnes@intel.com>
29  */
30 #include <linux/kernel.h>
31 #include <linux/sysrq.h>
32 #include <linux/slab.h>
33 #include <linux/fb.h>
34 #include "drmP.h"
35 #include "drm_crtc.h"
36 #include "drm_fb_helper.h"
37 #include "drm_crtc_helper.h"
38 
39 MODULE_AUTHOR("David Airlie, Jesse Barnes");
40 MODULE_DESCRIPTION("DRM KMS helper");
41 MODULE_LICENSE("GPL and additional rights");
42 
43 static LIST_HEAD(kernel_fb_helper_list);
44 
45 /* simple single crtc case helper function */
46 int drm_fb_helper_single_add_all_connectors(struct drm_fb_helper *fb_helper)
47 {
48 	struct drm_device *dev = fb_helper->dev;
49 	struct drm_connector *connector;
50 	int i;
51 
52 	list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
53 		struct drm_fb_helper_connector *fb_helper_connector;
54 
55 		fb_helper_connector = kzalloc(sizeof(struct drm_fb_helper_connector), GFP_KERNEL);
56 		if (!fb_helper_connector)
57 			goto fail;
58 
59 		fb_helper_connector->connector = connector;
60 		fb_helper->connector_info[fb_helper->connector_count++] = fb_helper_connector;
61 	}
62 	return 0;
63 fail:
64 	for (i = 0; i < fb_helper->connector_count; i++) {
65 		kfree(fb_helper->connector_info[i]);
66 		fb_helper->connector_info[i] = NULL;
67 	}
68 	fb_helper->connector_count = 0;
69 	return -ENOMEM;
70 }
71 EXPORT_SYMBOL(drm_fb_helper_single_add_all_connectors);
72 
73 /**
74  * drm_fb_helper_connector_parse_command_line - parse command line for connector
75  * @connector - connector to parse line for
76  * @mode_option - per connector mode option
77  *
78  * This parses the connector specific then generic command lines for
79  * modes and options to configure the connector.
80  *
81  * This uses the same parameters as the fb modedb.c, except for extra
82  *	<xres>x<yres>[M][R][-<bpp>][@<refresh>][i][m][eDd]
83  *
84  * enable/enable Digital/disable bit at the end
85  */
86 static bool drm_fb_helper_connector_parse_command_line(struct drm_fb_helper_connector *fb_helper_conn,
87 						       const char *mode_option)
88 {
89 	const char *name;
90 	unsigned int namelen;
91 	int res_specified = 0, bpp_specified = 0, refresh_specified = 0;
92 	unsigned int xres = 0, yres = 0, bpp = 32, refresh = 0;
93 	int yres_specified = 0, cvt = 0, rb = 0, interlace = 0, margins = 0;
94 	int i;
95 	enum drm_connector_force force = DRM_FORCE_UNSPECIFIED;
96 	struct drm_fb_helper_cmdline_mode *cmdline_mode;
97 	struct drm_connector *connector = fb_helper_conn->connector;
98 
99 	if (!fb_helper_conn)
100 		return false;
101 
102 	cmdline_mode = &fb_helper_conn->cmdline_mode;
103 	if (!mode_option)
104 		mode_option = fb_mode_option;
105 
106 	if (!mode_option) {
107 		cmdline_mode->specified = false;
108 		return false;
109 	}
110 
111 	name = mode_option;
112 	namelen = strlen(name);
113 	for (i = namelen-1; i >= 0; i--) {
114 		switch (name[i]) {
115 		case '@':
116 			namelen = i;
117 			if (!refresh_specified && !bpp_specified &&
118 			    !yres_specified) {
119 				refresh = simple_strtol(&name[i+1], NULL, 10);
120 				refresh_specified = 1;
121 				if (cvt || rb)
122 					cvt = 0;
123 			} else
124 				goto done;
125 			break;
126 		case '-':
127 			namelen = i;
128 			if (!bpp_specified && !yres_specified) {
129 				bpp = simple_strtol(&name[i+1], NULL, 10);
130 				bpp_specified = 1;
131 				if (cvt || rb)
132 					cvt = 0;
133 			} else
134 				goto done;
135 			break;
136 		case 'x':
137 			if (!yres_specified) {
138 				yres = simple_strtol(&name[i+1], NULL, 10);
139 				yres_specified = 1;
140 			} else
141 				goto done;
142 		case '0' ... '9':
143 			break;
144 		case 'M':
145 			if (!yres_specified)
146 				cvt = 1;
147 			break;
148 		case 'R':
149 			if (cvt)
150 				rb = 1;
151 			break;
152 		case 'm':
153 			if (!cvt)
154 				margins = 1;
155 			break;
156 		case 'i':
157 			if (!cvt)
158 				interlace = 1;
159 			break;
160 		case 'e':
161 			force = DRM_FORCE_ON;
162 			break;
163 		case 'D':
164 			if ((connector->connector_type != DRM_MODE_CONNECTOR_DVII) &&
165 			    (connector->connector_type != DRM_MODE_CONNECTOR_HDMIB))
166 				force = DRM_FORCE_ON;
167 			else
168 				force = DRM_FORCE_ON_DIGITAL;
169 			break;
170 		case 'd':
171 			force = DRM_FORCE_OFF;
172 			break;
173 		default:
174 			goto done;
175 		}
176 	}
177 	if (i < 0 && yres_specified) {
178 		xres = simple_strtol(name, NULL, 10);
179 		res_specified = 1;
180 	}
181 done:
182 
183 	DRM_DEBUG_KMS("cmdline mode for connector %s %dx%d@%dHz%s%s%s\n",
184 		drm_get_connector_name(connector), xres, yres,
185 		(refresh) ? refresh : 60, (rb) ? " reduced blanking" :
186 		"", (margins) ? " with margins" : "", (interlace) ?
187 		" interlaced" : "");
188 
189 	if (force) {
190 		const char *s;
191 		switch (force) {
192 		case DRM_FORCE_OFF: s = "OFF"; break;
193 		case DRM_FORCE_ON_DIGITAL: s = "ON - dig"; break;
194 		default:
195 		case DRM_FORCE_ON: s = "ON"; break;
196 		}
197 
198 		DRM_INFO("forcing %s connector %s\n",
199 			 drm_get_connector_name(connector), s);
200 		connector->force = force;
201 	}
202 
203 	if (res_specified) {
204 		cmdline_mode->specified = true;
205 		cmdline_mode->xres = xres;
206 		cmdline_mode->yres = yres;
207 	}
208 
209 	if (refresh_specified) {
210 		cmdline_mode->refresh_specified = true;
211 		cmdline_mode->refresh = refresh;
212 	}
213 
214 	if (bpp_specified) {
215 		cmdline_mode->bpp_specified = true;
216 		cmdline_mode->bpp = bpp;
217 	}
218 	cmdline_mode->rb = rb ? true : false;
219 	cmdline_mode->cvt = cvt  ? true : false;
220 	cmdline_mode->interlace = interlace ? true : false;
221 
222 	return true;
223 }
224 
225 static int drm_fb_helper_parse_command_line(struct drm_fb_helper *fb_helper)
226 {
227 	struct drm_fb_helper_connector *fb_helper_conn;
228 	int i;
229 
230 	for (i = 0; i < fb_helper->connector_count; i++) {
231 		char *option = NULL;
232 
233 		fb_helper_conn = fb_helper->connector_info[i];
234 
235 		/* do something on return - turn off connector maybe */
236 		if (fb_get_options(drm_get_connector_name(fb_helper_conn->connector), &option))
237 			continue;
238 
239 		drm_fb_helper_connector_parse_command_line(fb_helper_conn, option);
240 	}
241 	return 0;
242 }
243 
244 bool drm_fb_helper_force_kernel_mode(void)
245 {
246 	int i = 0;
247 	bool ret, error = false;
248 	struct drm_fb_helper *helper;
249 
250 	if (list_empty(&kernel_fb_helper_list))
251 		return false;
252 
253 	list_for_each_entry(helper, &kernel_fb_helper_list, kernel_fb_list) {
254 		for (i = 0; i < helper->crtc_count; i++) {
255 			struct drm_mode_set *mode_set = &helper->crtc_info[i].mode_set;
256 			ret = drm_crtc_helper_set_config(mode_set);
257 			if (ret)
258 				error = true;
259 		}
260 	}
261 	return error;
262 }
263 
264 int drm_fb_helper_panic(struct notifier_block *n, unsigned long ununsed,
265 			void *panic_str)
266 {
267 	printk(KERN_ERR "panic occurred, switching back to text console\n");
268 	return drm_fb_helper_force_kernel_mode();
269 	return 0;
270 }
271 EXPORT_SYMBOL(drm_fb_helper_panic);
272 
273 static struct notifier_block paniced = {
274 	.notifier_call = drm_fb_helper_panic,
275 };
276 
277 /**
278  * drm_fb_helper_restore - restore the framebuffer console (kernel) config
279  *
280  * Restore's the kernel's fbcon mode, used for lastclose & panic paths.
281  */
282 void drm_fb_helper_restore(void)
283 {
284 	bool ret;
285 	ret = drm_fb_helper_force_kernel_mode();
286 	if (ret == true)
287 		DRM_ERROR("Failed to restore crtc configuration\n");
288 }
289 EXPORT_SYMBOL(drm_fb_helper_restore);
290 
291 #ifdef CONFIG_MAGIC_SYSRQ
292 static void drm_fb_helper_restore_work_fn(struct work_struct *ignored)
293 {
294 	drm_fb_helper_restore();
295 }
296 static DECLARE_WORK(drm_fb_helper_restore_work, drm_fb_helper_restore_work_fn);
297 
298 static void drm_fb_helper_sysrq(int dummy1, struct tty_struct *dummy3)
299 {
300 	schedule_work(&drm_fb_helper_restore_work);
301 }
302 
303 static struct sysrq_key_op sysrq_drm_fb_helper_restore_op = {
304 	.handler = drm_fb_helper_sysrq,
305 	.help_msg = "force-fb(V)",
306 	.action_msg = "Restore framebuffer console",
307 };
308 #else
309 static struct sysrq_key_op sysrq_drm_fb_helper_restore_op = { };
310 #endif
311 
312 static void drm_fb_helper_on(struct fb_info *info)
313 {
314 	struct drm_fb_helper *fb_helper = info->par;
315 	struct drm_device *dev = fb_helper->dev;
316 	struct drm_crtc *crtc;
317 	struct drm_crtc_helper_funcs *crtc_funcs;
318 	struct drm_encoder *encoder;
319 	int i;
320 
321 	/*
322 	 * For each CRTC in this fb, turn the crtc on then,
323 	 * find all associated encoders and turn them on.
324 	 */
325 	mutex_lock(&dev->mode_config.mutex);
326 	for (i = 0; i < fb_helper->crtc_count; i++) {
327 		crtc = fb_helper->crtc_info[i].mode_set.crtc;
328 		crtc_funcs = crtc->helper_private;
329 
330 		if (!crtc->enabled)
331 			continue;
332 
333 		crtc_funcs->dpms(crtc, DRM_MODE_DPMS_ON);
334 
335 
336 		/* Found a CRTC on this fb, now find encoders */
337 		list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
338 			if (encoder->crtc == crtc) {
339 				struct drm_encoder_helper_funcs *encoder_funcs;
340 
341 				encoder_funcs = encoder->helper_private;
342 				encoder_funcs->dpms(encoder, DRM_MODE_DPMS_ON);
343 			}
344 		}
345 	}
346 	mutex_unlock(&dev->mode_config.mutex);
347 }
348 
349 static void drm_fb_helper_off(struct fb_info *info, int dpms_mode)
350 {
351 	struct drm_fb_helper *fb_helper = info->par;
352 	struct drm_device *dev = fb_helper->dev;
353 	struct drm_crtc *crtc;
354 	struct drm_crtc_helper_funcs *crtc_funcs;
355 	struct drm_encoder *encoder;
356 	int i;
357 
358 	/*
359 	 * For each CRTC in this fb, find all associated encoders
360 	 * and turn them off, then turn off the CRTC.
361 	 */
362 	mutex_lock(&dev->mode_config.mutex);
363 	for (i = 0; i < fb_helper->crtc_count; i++) {
364 		crtc = fb_helper->crtc_info[i].mode_set.crtc;
365 		crtc_funcs = crtc->helper_private;
366 
367 		if (!crtc->enabled)
368 			continue;
369 
370 		/* Found a CRTC on this fb, now find encoders */
371 		list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
372 			if (encoder->crtc == crtc) {
373 				struct drm_encoder_helper_funcs *encoder_funcs;
374 
375 				encoder_funcs = encoder->helper_private;
376 				encoder_funcs->dpms(encoder, dpms_mode);
377 			}
378 		}
379 		crtc_funcs->dpms(crtc, DRM_MODE_DPMS_OFF);
380 	}
381 	mutex_unlock(&dev->mode_config.mutex);
382 }
383 
384 int drm_fb_helper_blank(int blank, struct fb_info *info)
385 {
386 	switch (blank) {
387 	/* Display: On; HSync: On, VSync: On */
388 	case FB_BLANK_UNBLANK:
389 		drm_fb_helper_on(info);
390 		break;
391 	/* Display: Off; HSync: On, VSync: On */
392 	case FB_BLANK_NORMAL:
393 		drm_fb_helper_off(info, DRM_MODE_DPMS_STANDBY);
394 		break;
395 	/* Display: Off; HSync: Off, VSync: On */
396 	case FB_BLANK_HSYNC_SUSPEND:
397 		drm_fb_helper_off(info, DRM_MODE_DPMS_STANDBY);
398 		break;
399 	/* Display: Off; HSync: On, VSync: Off */
400 	case FB_BLANK_VSYNC_SUSPEND:
401 		drm_fb_helper_off(info, DRM_MODE_DPMS_SUSPEND);
402 		break;
403 	/* Display: Off; HSync: Off, VSync: Off */
404 	case FB_BLANK_POWERDOWN:
405 		drm_fb_helper_off(info, DRM_MODE_DPMS_OFF);
406 		break;
407 	}
408 	return 0;
409 }
410 EXPORT_SYMBOL(drm_fb_helper_blank);
411 
412 static void drm_fb_helper_crtc_free(struct drm_fb_helper *helper)
413 {
414 	int i;
415 
416 	for (i = 0; i < helper->connector_count; i++)
417 		kfree(helper->connector_info[i]);
418 	kfree(helper->connector_info);
419 	for (i = 0; i < helper->crtc_count; i++)
420 		kfree(helper->crtc_info[i].mode_set.connectors);
421 	kfree(helper->crtc_info);
422 }
423 
424 int drm_fb_helper_init(struct drm_device *dev,
425 		       struct drm_fb_helper *fb_helper,
426 		       int crtc_count, int max_conn_count)
427 {
428 	struct drm_crtc *crtc;
429 	int ret = 0;
430 	int i;
431 
432 	fb_helper->dev = dev;
433 
434 	INIT_LIST_HEAD(&fb_helper->kernel_fb_list);
435 
436 	fb_helper->crtc_info = kcalloc(crtc_count, sizeof(struct drm_fb_helper_crtc), GFP_KERNEL);
437 	if (!fb_helper->crtc_info)
438 		return -ENOMEM;
439 
440 	fb_helper->crtc_count = crtc_count;
441 	fb_helper->connector_info = kcalloc(dev->mode_config.num_connector, sizeof(struct drm_fb_helper_connector *), GFP_KERNEL);
442 	if (!fb_helper->connector_info) {
443 		kfree(fb_helper->crtc_info);
444 		return -ENOMEM;
445 	}
446 	fb_helper->connector_count = 0;
447 
448 	for (i = 0; i < crtc_count; i++) {
449 		fb_helper->crtc_info[i].mode_set.connectors =
450 			kcalloc(max_conn_count,
451 				sizeof(struct drm_connector *),
452 				GFP_KERNEL);
453 
454 		if (!fb_helper->crtc_info[i].mode_set.connectors) {
455 			ret = -ENOMEM;
456 			goto out_free;
457 		}
458 		fb_helper->crtc_info[i].mode_set.num_connectors = 0;
459 	}
460 
461 	i = 0;
462 	list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) {
463 		fb_helper->crtc_info[i].crtc_id = crtc->base.id;
464 		fb_helper->crtc_info[i].mode_set.crtc = crtc;
465 		i++;
466 	}
467 	fb_helper->conn_limit = max_conn_count;
468 	return 0;
469 out_free:
470 	drm_fb_helper_crtc_free(fb_helper);
471 	return -ENOMEM;
472 }
473 EXPORT_SYMBOL(drm_fb_helper_init);
474 
475 void drm_fb_helper_fini(struct drm_fb_helper *fb_helper)
476 {
477 	if (!list_empty(&fb_helper->kernel_fb_list)) {
478 		list_del(&fb_helper->kernel_fb_list);
479 		if (list_empty(&kernel_fb_helper_list)) {
480 			printk(KERN_INFO "drm: unregistered panic notifier\n");
481 			atomic_notifier_chain_unregister(&panic_notifier_list,
482 							 &paniced);
483 			unregister_sysrq_key('v', &sysrq_drm_fb_helper_restore_op);
484 		}
485 	}
486 
487 	drm_fb_helper_crtc_free(fb_helper);
488 
489 }
490 EXPORT_SYMBOL(drm_fb_helper_fini);
491 
492 static int setcolreg(struct drm_crtc *crtc, u16 red, u16 green,
493 		     u16 blue, u16 regno, struct fb_info *info)
494 {
495 	struct drm_fb_helper *fb_helper = info->par;
496 	struct drm_framebuffer *fb = fb_helper->fb;
497 	int pindex;
498 
499 	if (info->fix.visual == FB_VISUAL_TRUECOLOR) {
500 		u32 *palette;
501 		u32 value;
502 		/* place color in psuedopalette */
503 		if (regno > 16)
504 			return -EINVAL;
505 		palette = (u32 *)info->pseudo_palette;
506 		red >>= (16 - info->var.red.length);
507 		green >>= (16 - info->var.green.length);
508 		blue >>= (16 - info->var.blue.length);
509 		value = (red << info->var.red.offset) |
510 			(green << info->var.green.offset) |
511 			(blue << info->var.blue.offset);
512 		palette[regno] = value;
513 		return 0;
514 	}
515 
516 	pindex = regno;
517 
518 	if (fb->bits_per_pixel == 16) {
519 		pindex = regno << 3;
520 
521 		if (fb->depth == 16 && regno > 63)
522 			return -EINVAL;
523 		if (fb->depth == 15 && regno > 31)
524 			return -EINVAL;
525 
526 		if (fb->depth == 16) {
527 			u16 r, g, b;
528 			int i;
529 			if (regno < 32) {
530 				for (i = 0; i < 8; i++)
531 					fb_helper->funcs->gamma_set(crtc, red,
532 						green, blue, pindex + i);
533 			}
534 
535 			fb_helper->funcs->gamma_get(crtc, &r,
536 						    &g, &b,
537 						    pindex >> 1);
538 
539 			for (i = 0; i < 4; i++)
540 				fb_helper->funcs->gamma_set(crtc, r,
541 							    green, b,
542 							    (pindex >> 1) + i);
543 		}
544 	}
545 
546 	if (fb->depth != 16)
547 		fb_helper->funcs->gamma_set(crtc, red, green, blue, pindex);
548 	return 0;
549 }
550 
551 int drm_fb_helper_setcmap(struct fb_cmap *cmap, struct fb_info *info)
552 {
553 	struct drm_fb_helper *fb_helper = info->par;
554 	struct drm_crtc_helper_funcs *crtc_funcs;
555 	u16 *red, *green, *blue, *transp;
556 	struct drm_crtc *crtc;
557 	int i, rc = 0;
558 	int start;
559 
560 	for (i = 0; i < fb_helper->crtc_count; i++) {
561 		crtc = fb_helper->crtc_info[i].mode_set.crtc;
562 		crtc_funcs = crtc->helper_private;
563 
564 		red = cmap->red;
565 		green = cmap->green;
566 		blue = cmap->blue;
567 		transp = cmap->transp;
568 		start = cmap->start;
569 
570 		for (i = 0; i < cmap->len; i++) {
571 			u16 hred, hgreen, hblue, htransp = 0xffff;
572 
573 			hred = *red++;
574 			hgreen = *green++;
575 			hblue = *blue++;
576 
577 			if (transp)
578 				htransp = *transp++;
579 
580 			rc = setcolreg(crtc, hred, hgreen, hblue, start++, info);
581 			if (rc)
582 				return rc;
583 		}
584 		crtc_funcs->load_lut(crtc);
585 	}
586 	return rc;
587 }
588 EXPORT_SYMBOL(drm_fb_helper_setcmap);
589 
590 int drm_fb_helper_check_var(struct fb_var_screeninfo *var,
591 			    struct fb_info *info)
592 {
593 	struct drm_fb_helper *fb_helper = info->par;
594 	struct drm_framebuffer *fb = fb_helper->fb;
595 	int depth;
596 
597 	if (var->pixclock != 0)
598 		return -EINVAL;
599 
600 	/* Need to resize the fb object !!! */
601 	if (var->bits_per_pixel > fb->bits_per_pixel || var->xres > fb->width || var->yres > fb->height) {
602 		DRM_DEBUG("fb userspace requested width/height/bpp is greater than current fb "
603 			  "object %dx%d-%d > %dx%d-%d\n", var->xres, var->yres, var->bits_per_pixel,
604 			  fb->width, fb->height, fb->bits_per_pixel);
605 		return -EINVAL;
606 	}
607 
608 	switch (var->bits_per_pixel) {
609 	case 16:
610 		depth = (var->green.length == 6) ? 16 : 15;
611 		break;
612 	case 32:
613 		depth = (var->transp.length > 0) ? 32 : 24;
614 		break;
615 	default:
616 		depth = var->bits_per_pixel;
617 		break;
618 	}
619 
620 	switch (depth) {
621 	case 8:
622 		var->red.offset = 0;
623 		var->green.offset = 0;
624 		var->blue.offset = 0;
625 		var->red.length = 8;
626 		var->green.length = 8;
627 		var->blue.length = 8;
628 		var->transp.length = 0;
629 		var->transp.offset = 0;
630 		break;
631 	case 15:
632 		var->red.offset = 10;
633 		var->green.offset = 5;
634 		var->blue.offset = 0;
635 		var->red.length = 5;
636 		var->green.length = 5;
637 		var->blue.length = 5;
638 		var->transp.length = 1;
639 		var->transp.offset = 15;
640 		break;
641 	case 16:
642 		var->red.offset = 11;
643 		var->green.offset = 5;
644 		var->blue.offset = 0;
645 		var->red.length = 5;
646 		var->green.length = 6;
647 		var->blue.length = 5;
648 		var->transp.length = 0;
649 		var->transp.offset = 0;
650 		break;
651 	case 24:
652 		var->red.offset = 16;
653 		var->green.offset = 8;
654 		var->blue.offset = 0;
655 		var->red.length = 8;
656 		var->green.length = 8;
657 		var->blue.length = 8;
658 		var->transp.length = 0;
659 		var->transp.offset = 0;
660 		break;
661 	case 32:
662 		var->red.offset = 16;
663 		var->green.offset = 8;
664 		var->blue.offset = 0;
665 		var->red.length = 8;
666 		var->green.length = 8;
667 		var->blue.length = 8;
668 		var->transp.length = 8;
669 		var->transp.offset = 24;
670 		break;
671 	default:
672 		return -EINVAL;
673 	}
674 	return 0;
675 }
676 EXPORT_SYMBOL(drm_fb_helper_check_var);
677 
678 /* this will let fbcon do the mode init */
679 int drm_fb_helper_set_par(struct fb_info *info)
680 {
681 	struct drm_fb_helper *fb_helper = info->par;
682 	struct drm_device *dev = fb_helper->dev;
683 	struct fb_var_screeninfo *var = &info->var;
684 	struct drm_crtc *crtc;
685 	int ret;
686 	int i;
687 
688 	if (var->pixclock != 0) {
689 		DRM_ERROR("PIXEL CLOCK SET\n");
690 		return -EINVAL;
691 	}
692 
693 	mutex_lock(&dev->mode_config.mutex);
694 	for (i = 0; i < fb_helper->crtc_count; i++) {
695 		crtc = fb_helper->crtc_info[i].mode_set.crtc;
696 		ret = crtc->funcs->set_config(&fb_helper->crtc_info[i].mode_set);
697 		if (ret) {
698 			mutex_unlock(&dev->mode_config.mutex);
699 			return ret;
700 		}
701 	}
702 	mutex_unlock(&dev->mode_config.mutex);
703 
704 	if (fb_helper->delayed_hotplug) {
705 		fb_helper->delayed_hotplug = false;
706 		drm_fb_helper_hotplug_event(fb_helper);
707 	}
708 	return 0;
709 }
710 EXPORT_SYMBOL(drm_fb_helper_set_par);
711 
712 int drm_fb_helper_pan_display(struct fb_var_screeninfo *var,
713 			      struct fb_info *info)
714 {
715 	struct drm_fb_helper *fb_helper = info->par;
716 	struct drm_device *dev = fb_helper->dev;
717 	struct drm_mode_set *modeset;
718 	struct drm_crtc *crtc;
719 	int ret = 0;
720 	int i;
721 
722 	mutex_lock(&dev->mode_config.mutex);
723 	for (i = 0; i < fb_helper->crtc_count; i++) {
724 		crtc = fb_helper->crtc_info[i].mode_set.crtc;
725 
726 		modeset = &fb_helper->crtc_info[i].mode_set;
727 
728 		modeset->x = var->xoffset;
729 		modeset->y = var->yoffset;
730 
731 		if (modeset->num_connectors) {
732 			ret = crtc->funcs->set_config(modeset);
733 			if (!ret) {
734 				info->var.xoffset = var->xoffset;
735 				info->var.yoffset = var->yoffset;
736 			}
737 		}
738 	}
739 	mutex_unlock(&dev->mode_config.mutex);
740 	return ret;
741 }
742 EXPORT_SYMBOL(drm_fb_helper_pan_display);
743 
744 int drm_fb_helper_single_fb_probe(struct drm_fb_helper *fb_helper,
745 				  int preferred_bpp)
746 {
747 	int new_fb = 0;
748 	int crtc_count = 0;
749 	int i;
750 	struct fb_info *info;
751 	struct drm_fb_helper_surface_size sizes;
752 	int gamma_size = 0;
753 
754 	memset(&sizes, 0, sizeof(struct drm_fb_helper_surface_size));
755 	sizes.surface_depth = 24;
756 	sizes.surface_bpp = 32;
757 	sizes.fb_width = (unsigned)-1;
758 	sizes.fb_height = (unsigned)-1;
759 
760 	/* if driver picks 8 or 16 by default use that
761 	   for both depth/bpp */
762 	if (preferred_bpp != sizes.surface_bpp) {
763 		sizes.surface_depth = sizes.surface_bpp = preferred_bpp;
764 	}
765 	/* first up get a count of crtcs now in use and new min/maxes width/heights */
766 	for (i = 0; i < fb_helper->connector_count; i++) {
767 		struct drm_fb_helper_connector *fb_helper_conn = fb_helper->connector_info[i];
768 		struct drm_fb_helper_cmdline_mode *cmdline_mode;
769 
770 		cmdline_mode = &fb_helper_conn->cmdline_mode;
771 
772 		if (cmdline_mode->bpp_specified) {
773 			switch (cmdline_mode->bpp) {
774 			case 8:
775 				sizes.surface_depth = sizes.surface_bpp = 8;
776 				break;
777 			case 15:
778 				sizes.surface_depth = 15;
779 				sizes.surface_bpp = 16;
780 				break;
781 			case 16:
782 				sizes.surface_depth = sizes.surface_bpp = 16;
783 				break;
784 			case 24:
785 				sizes.surface_depth = sizes.surface_bpp = 24;
786 				break;
787 			case 32:
788 				sizes.surface_depth = 24;
789 				sizes.surface_bpp = 32;
790 				break;
791 			}
792 			break;
793 		}
794 	}
795 
796 	crtc_count = 0;
797 	for (i = 0; i < fb_helper->crtc_count; i++) {
798 		struct drm_display_mode *desired_mode;
799 		desired_mode = fb_helper->crtc_info[i].desired_mode;
800 
801 		if (desired_mode) {
802 			if (gamma_size == 0)
803 				gamma_size = fb_helper->crtc_info[i].mode_set.crtc->gamma_size;
804 			if (desired_mode->hdisplay < sizes.fb_width)
805 				sizes.fb_width = desired_mode->hdisplay;
806 			if (desired_mode->vdisplay < sizes.fb_height)
807 				sizes.fb_height = desired_mode->vdisplay;
808 			if (desired_mode->hdisplay > sizes.surface_width)
809 				sizes.surface_width = desired_mode->hdisplay;
810 			if (desired_mode->vdisplay > sizes.surface_height)
811 				sizes.surface_height = desired_mode->vdisplay;
812 			crtc_count++;
813 		}
814 	}
815 
816 	if (crtc_count == 0 || sizes.fb_width == -1 || sizes.fb_height == -1) {
817 		/* hmm everyone went away - assume VGA cable just fell out
818 		   and will come back later. */
819 		DRM_INFO("Cannot find any crtc or sizes - going 1024x768\n");
820 		sizes.fb_width = sizes.surface_width = 1024;
821 		sizes.fb_height = sizes.surface_height = 768;
822 	}
823 
824 	/* push down into drivers */
825 	new_fb = (*fb_helper->funcs->fb_probe)(fb_helper, &sizes);
826 	if (new_fb < 0)
827 		return new_fb;
828 
829 	info = fb_helper->fbdev;
830 
831 	/* set the fb pointer */
832 	for (i = 0; i < fb_helper->crtc_count; i++) {
833 		fb_helper->crtc_info[i].mode_set.fb = fb_helper->fb;
834 	}
835 
836 	if (new_fb) {
837 		info->var.pixclock = 0;
838 		if (register_framebuffer(info) < 0) {
839 			return -EINVAL;
840 		}
841 
842 		printk(KERN_INFO "fb%d: %s frame buffer device\n", info->node,
843 		       info->fix.id);
844 
845 	} else {
846 		drm_fb_helper_set_par(info);
847 	}
848 
849 	/* Switch back to kernel console on panic */
850 	/* multi card linked list maybe */
851 	if (list_empty(&kernel_fb_helper_list)) {
852 		printk(KERN_INFO "drm: registered panic notifier\n");
853 		atomic_notifier_chain_register(&panic_notifier_list,
854 					       &paniced);
855 		register_sysrq_key('v', &sysrq_drm_fb_helper_restore_op);
856 	}
857 	if (new_fb)
858 		list_add(&fb_helper->kernel_fb_list, &kernel_fb_helper_list);
859 
860 	return 0;
861 }
862 EXPORT_SYMBOL(drm_fb_helper_single_fb_probe);
863 
864 void drm_fb_helper_fill_fix(struct fb_info *info, uint32_t pitch,
865 			    uint32_t depth)
866 {
867 	info->fix.type = FB_TYPE_PACKED_PIXELS;
868 	info->fix.visual = depth == 8 ? FB_VISUAL_PSEUDOCOLOR :
869 		FB_VISUAL_TRUECOLOR;
870 	info->fix.type_aux = 0;
871 	info->fix.xpanstep = 1; /* doing it in hw */
872 	info->fix.ypanstep = 1; /* doing it in hw */
873 	info->fix.ywrapstep = 0;
874 	info->fix.accel = FB_ACCEL_NONE;
875 	info->fix.type_aux = 0;
876 
877 	info->fix.line_length = pitch;
878 	return;
879 }
880 EXPORT_SYMBOL(drm_fb_helper_fill_fix);
881 
882 void drm_fb_helper_fill_var(struct fb_info *info, struct drm_fb_helper *fb_helper,
883 			    uint32_t fb_width, uint32_t fb_height)
884 {
885 	struct drm_framebuffer *fb = fb_helper->fb;
886 	info->pseudo_palette = fb_helper->pseudo_palette;
887 	info->var.xres_virtual = fb->width;
888 	info->var.yres_virtual = fb->height;
889 	info->var.bits_per_pixel = fb->bits_per_pixel;
890 	info->var.xoffset = 0;
891 	info->var.yoffset = 0;
892 	info->var.activate = FB_ACTIVATE_NOW;
893 	info->var.height = -1;
894 	info->var.width = -1;
895 
896 	switch (fb->depth) {
897 	case 8:
898 		info->var.red.offset = 0;
899 		info->var.green.offset = 0;
900 		info->var.blue.offset = 0;
901 		info->var.red.length = 8; /* 8bit DAC */
902 		info->var.green.length = 8;
903 		info->var.blue.length = 8;
904 		info->var.transp.offset = 0;
905 		info->var.transp.length = 0;
906 		break;
907 	case 15:
908 		info->var.red.offset = 10;
909 		info->var.green.offset = 5;
910 		info->var.blue.offset = 0;
911 		info->var.red.length = 5;
912 		info->var.green.length = 5;
913 		info->var.blue.length = 5;
914 		info->var.transp.offset = 15;
915 		info->var.transp.length = 1;
916 		break;
917 	case 16:
918 		info->var.red.offset = 11;
919 		info->var.green.offset = 5;
920 		info->var.blue.offset = 0;
921 		info->var.red.length = 5;
922 		info->var.green.length = 6;
923 		info->var.blue.length = 5;
924 		info->var.transp.offset = 0;
925 		break;
926 	case 24:
927 		info->var.red.offset = 16;
928 		info->var.green.offset = 8;
929 		info->var.blue.offset = 0;
930 		info->var.red.length = 8;
931 		info->var.green.length = 8;
932 		info->var.blue.length = 8;
933 		info->var.transp.offset = 0;
934 		info->var.transp.length = 0;
935 		break;
936 	case 32:
937 		info->var.red.offset = 16;
938 		info->var.green.offset = 8;
939 		info->var.blue.offset = 0;
940 		info->var.red.length = 8;
941 		info->var.green.length = 8;
942 		info->var.blue.length = 8;
943 		info->var.transp.offset = 24;
944 		info->var.transp.length = 8;
945 		break;
946 	default:
947 		break;
948 	}
949 
950 	info->var.xres = fb_width;
951 	info->var.yres = fb_height;
952 }
953 EXPORT_SYMBOL(drm_fb_helper_fill_var);
954 
955 static int drm_fb_helper_probe_connector_modes(struct drm_fb_helper *fb_helper,
956 					       uint32_t maxX,
957 					       uint32_t maxY)
958 {
959 	struct drm_connector *connector;
960 	int count = 0;
961 	int i;
962 
963 	for (i = 0; i < fb_helper->connector_count; i++) {
964 		connector = fb_helper->connector_info[i]->connector;
965 		count += connector->funcs->fill_modes(connector, maxX, maxY);
966 	}
967 
968 	return count;
969 }
970 
971 static struct drm_display_mode *drm_has_preferred_mode(struct drm_fb_helper_connector *fb_connector, int width, int height)
972 {
973 	struct drm_display_mode *mode;
974 
975 	list_for_each_entry(mode, &fb_connector->connector->modes, head) {
976 		if (drm_mode_width(mode) > width ||
977 		    drm_mode_height(mode) > height)
978 			continue;
979 		if (mode->type & DRM_MODE_TYPE_PREFERRED)
980 			return mode;
981 	}
982 	return NULL;
983 }
984 
985 static bool drm_has_cmdline_mode(struct drm_fb_helper_connector *fb_connector)
986 {
987 	struct drm_fb_helper_cmdline_mode *cmdline_mode;
988 	cmdline_mode = &fb_connector->cmdline_mode;
989 	return cmdline_mode->specified;
990 }
991 
992 static struct drm_display_mode *drm_pick_cmdline_mode(struct drm_fb_helper_connector *fb_helper_conn,
993 						      int width, int height)
994 {
995 	struct drm_fb_helper_cmdline_mode *cmdline_mode;
996 	struct drm_display_mode *mode = NULL;
997 
998 	cmdline_mode = &fb_helper_conn->cmdline_mode;
999 	if (cmdline_mode->specified == false)
1000 		return mode;
1001 
1002 	/* attempt to find a matching mode in the list of modes
1003 	 *  we have gotten so far, if not add a CVT mode that conforms
1004 	 */
1005 	if (cmdline_mode->rb || cmdline_mode->margins)
1006 		goto create_mode;
1007 
1008 	list_for_each_entry(mode, &fb_helper_conn->connector->modes, head) {
1009 		/* check width/height */
1010 		if (mode->hdisplay != cmdline_mode->xres ||
1011 		    mode->vdisplay != cmdline_mode->yres)
1012 			continue;
1013 
1014 		if (cmdline_mode->refresh_specified) {
1015 			if (mode->vrefresh != cmdline_mode->refresh)
1016 				continue;
1017 		}
1018 
1019 		if (cmdline_mode->interlace) {
1020 			if (!(mode->flags & DRM_MODE_FLAG_INTERLACE))
1021 				continue;
1022 		}
1023 		return mode;
1024 	}
1025 
1026 create_mode:
1027 	if (cmdline_mode->cvt)
1028 		mode = drm_cvt_mode(fb_helper_conn->connector->dev,
1029 				    cmdline_mode->xres, cmdline_mode->yres,
1030 				    cmdline_mode->refresh_specified ? cmdline_mode->refresh : 60,
1031 				    cmdline_mode->rb, cmdline_mode->interlace,
1032 				    cmdline_mode->margins);
1033 	else
1034 		mode = drm_gtf_mode(fb_helper_conn->connector->dev,
1035 				    cmdline_mode->xres, cmdline_mode->yres,
1036 				    cmdline_mode->refresh_specified ? cmdline_mode->refresh : 60,
1037 				    cmdline_mode->interlace,
1038 				    cmdline_mode->margins);
1039 	drm_mode_set_crtcinfo(mode, CRTC_INTERLACE_HALVE_V);
1040 	list_add(&mode->head, &fb_helper_conn->connector->modes);
1041 	return mode;
1042 }
1043 
1044 static bool drm_connector_enabled(struct drm_connector *connector, bool strict)
1045 {
1046 	bool enable;
1047 
1048 	if (strict) {
1049 		enable = connector->status == connector_status_connected;
1050 	} else {
1051 		enable = connector->status != connector_status_disconnected;
1052 	}
1053 	return enable;
1054 }
1055 
1056 static void drm_enable_connectors(struct drm_fb_helper *fb_helper,
1057 				  bool *enabled)
1058 {
1059 	bool any_enabled = false;
1060 	struct drm_connector *connector;
1061 	int i = 0;
1062 
1063 	for (i = 0; i < fb_helper->connector_count; i++) {
1064 		connector = fb_helper->connector_info[i]->connector;
1065 		enabled[i] = drm_connector_enabled(connector, true);
1066 		DRM_DEBUG_KMS("connector %d enabled? %s\n", connector->base.id,
1067 			  enabled[i] ? "yes" : "no");
1068 		any_enabled |= enabled[i];
1069 	}
1070 
1071 	if (any_enabled)
1072 		return;
1073 
1074 	for (i = 0; i < fb_helper->connector_count; i++) {
1075 		connector = fb_helper->connector_info[i]->connector;
1076 		enabled[i] = drm_connector_enabled(connector, false);
1077 	}
1078 }
1079 
1080 static bool drm_target_cloned(struct drm_fb_helper *fb_helper,
1081 			      struct drm_display_mode **modes,
1082 			      bool *enabled, int width, int height)
1083 {
1084 	int count, i, j;
1085 	bool can_clone = false;
1086 	struct drm_fb_helper_connector *fb_helper_conn;
1087 	struct drm_display_mode *dmt_mode, *mode;
1088 
1089 	/* only contemplate cloning in the single crtc case */
1090 	if (fb_helper->crtc_count > 1)
1091 		return false;
1092 
1093 	count = 0;
1094 	for (i = 0; i < fb_helper->connector_count; i++) {
1095 		if (enabled[i])
1096 			count++;
1097 	}
1098 
1099 	/* only contemplate cloning if more than one connector is enabled */
1100 	if (count <= 1)
1101 		return false;
1102 
1103 	/* check the command line or if nothing common pick 1024x768 */
1104 	can_clone = true;
1105 	for (i = 0; i < fb_helper->connector_count; i++) {
1106 		if (!enabled[i])
1107 			continue;
1108 		fb_helper_conn = fb_helper->connector_info[i];
1109 		modes[i] = drm_pick_cmdline_mode(fb_helper_conn, width, height);
1110 		if (!modes[i]) {
1111 			can_clone = false;
1112 			break;
1113 		}
1114 		for (j = 0; j < i; j++) {
1115 			if (!enabled[j])
1116 				continue;
1117 			if (!drm_mode_equal(modes[j], modes[i]))
1118 				can_clone = false;
1119 		}
1120 	}
1121 
1122 	if (can_clone) {
1123 		DRM_DEBUG_KMS("can clone using command line\n");
1124 		return true;
1125 	}
1126 
1127 	/* try and find a 1024x768 mode on each connector */
1128 	can_clone = true;
1129 	dmt_mode = drm_mode_find_dmt(fb_helper->dev, 1024, 768, 60);
1130 
1131 	for (i = 0; i < fb_helper->connector_count; i++) {
1132 
1133 		if (!enabled[i])
1134 			continue;
1135 
1136 		fb_helper_conn = fb_helper->connector_info[i];
1137 		list_for_each_entry(mode, &fb_helper_conn->connector->modes, head) {
1138 			if (drm_mode_equal(mode, dmt_mode))
1139 				modes[i] = mode;
1140 		}
1141 		if (!modes[i])
1142 			can_clone = false;
1143 	}
1144 
1145 	if (can_clone) {
1146 		DRM_DEBUG_KMS("can clone using 1024x768\n");
1147 		return true;
1148 	}
1149 	DRM_INFO("kms: can't enable cloning when we probably wanted to.\n");
1150 	return false;
1151 }
1152 
1153 static bool drm_target_preferred(struct drm_fb_helper *fb_helper,
1154 				 struct drm_display_mode **modes,
1155 				 bool *enabled, int width, int height)
1156 {
1157 	struct drm_fb_helper_connector *fb_helper_conn;
1158 	int i;
1159 
1160 	for (i = 0; i < fb_helper->connector_count; i++) {
1161 		fb_helper_conn = fb_helper->connector_info[i];
1162 
1163 		if (enabled[i] == false)
1164 			continue;
1165 
1166 		DRM_DEBUG_KMS("looking for cmdline mode on connector %d\n",
1167 			      fb_helper_conn->connector->base.id);
1168 
1169 		/* got for command line mode first */
1170 		modes[i] = drm_pick_cmdline_mode(fb_helper_conn, width, height);
1171 		if (!modes[i]) {
1172 			DRM_DEBUG_KMS("looking for preferred mode on connector %d\n",
1173 				      fb_helper_conn->connector->base.id);
1174 			modes[i] = drm_has_preferred_mode(fb_helper_conn, width, height);
1175 		}
1176 		/* No preferred modes, pick one off the list */
1177 		if (!modes[i] && !list_empty(&fb_helper_conn->connector->modes)) {
1178 			list_for_each_entry(modes[i], &fb_helper_conn->connector->modes, head)
1179 				break;
1180 		}
1181 		DRM_DEBUG_KMS("found mode %s\n", modes[i] ? modes[i]->name :
1182 			  "none");
1183 	}
1184 	return true;
1185 }
1186 
1187 static int drm_pick_crtcs(struct drm_fb_helper *fb_helper,
1188 			  struct drm_fb_helper_crtc **best_crtcs,
1189 			  struct drm_display_mode **modes,
1190 			  int n, int width, int height)
1191 {
1192 	int c, o;
1193 	struct drm_device *dev = fb_helper->dev;
1194 	struct drm_connector *connector;
1195 	struct drm_connector_helper_funcs *connector_funcs;
1196 	struct drm_encoder *encoder;
1197 	struct drm_fb_helper_crtc *best_crtc;
1198 	int my_score, best_score, score;
1199 	struct drm_fb_helper_crtc **crtcs, *crtc;
1200 	struct drm_fb_helper_connector *fb_helper_conn;
1201 
1202 	if (n == fb_helper->connector_count)
1203 		return 0;
1204 
1205 	fb_helper_conn = fb_helper->connector_info[n];
1206 	connector = fb_helper_conn->connector;
1207 
1208 	best_crtcs[n] = NULL;
1209 	best_crtc = NULL;
1210 	best_score = drm_pick_crtcs(fb_helper, best_crtcs, modes, n+1, width, height);
1211 	if (modes[n] == NULL)
1212 		return best_score;
1213 
1214 	crtcs = kzalloc(dev->mode_config.num_connector *
1215 			sizeof(struct drm_fb_helper_crtc *), GFP_KERNEL);
1216 	if (!crtcs)
1217 		return best_score;
1218 
1219 	my_score = 1;
1220 	if (connector->status == connector_status_connected)
1221 		my_score++;
1222 	if (drm_has_cmdline_mode(fb_helper_conn))
1223 		my_score++;
1224 	if (drm_has_preferred_mode(fb_helper_conn, width, height))
1225 		my_score++;
1226 
1227 	connector_funcs = connector->helper_private;
1228 	encoder = connector_funcs->best_encoder(connector);
1229 	if (!encoder)
1230 		goto out;
1231 
1232 	/* select a crtc for this connector and then attempt to configure
1233 	   remaining connectors */
1234 	for (c = 0; c < fb_helper->crtc_count; c++) {
1235 		crtc = &fb_helper->crtc_info[c];
1236 
1237 		if ((encoder->possible_crtcs & (1 << c)) == 0) {
1238 			continue;
1239 		}
1240 
1241 		for (o = 0; o < n; o++)
1242 			if (best_crtcs[o] == crtc)
1243 				break;
1244 
1245 		if (o < n) {
1246 			/* ignore cloning unless only a single crtc */
1247 			if (fb_helper->crtc_count > 1)
1248 				continue;
1249 
1250 			if (!drm_mode_equal(modes[o], modes[n]))
1251 				continue;
1252 		}
1253 
1254 		crtcs[n] = crtc;
1255 		memcpy(crtcs, best_crtcs, n * sizeof(struct drm_fb_helper_crtc *));
1256 		score = my_score + drm_pick_crtcs(fb_helper, crtcs, modes, n + 1,
1257 						  width, height);
1258 		if (score > best_score) {
1259 			best_crtc = crtc;
1260 			best_score = score;
1261 			memcpy(best_crtcs, crtcs,
1262 			       dev->mode_config.num_connector *
1263 			       sizeof(struct drm_fb_helper_crtc *));
1264 		}
1265 	}
1266 out:
1267 	kfree(crtcs);
1268 	return best_score;
1269 }
1270 
1271 static void drm_setup_crtcs(struct drm_fb_helper *fb_helper)
1272 {
1273 	struct drm_device *dev = fb_helper->dev;
1274 	struct drm_fb_helper_crtc **crtcs;
1275 	struct drm_display_mode **modes;
1276 	struct drm_encoder *encoder;
1277 	struct drm_mode_set *modeset;
1278 	bool *enabled;
1279 	int width, height;
1280 	int i, ret;
1281 
1282 	DRM_DEBUG_KMS("\n");
1283 
1284 	width = dev->mode_config.max_width;
1285 	height = dev->mode_config.max_height;
1286 
1287 	/* clean out all the encoder/crtc combos */
1288 	list_for_each_entry(encoder, &dev->mode_config.encoder_list, head) {
1289 		encoder->crtc = NULL;
1290 	}
1291 
1292 	crtcs = kcalloc(dev->mode_config.num_connector,
1293 			sizeof(struct drm_fb_helper_crtc *), GFP_KERNEL);
1294 	modes = kcalloc(dev->mode_config.num_connector,
1295 			sizeof(struct drm_display_mode *), GFP_KERNEL);
1296 	enabled = kcalloc(dev->mode_config.num_connector,
1297 			  sizeof(bool), GFP_KERNEL);
1298 
1299 	drm_enable_connectors(fb_helper, enabled);
1300 
1301 	ret = drm_target_cloned(fb_helper, modes, enabled, width, height);
1302 	if (!ret) {
1303 		ret = drm_target_preferred(fb_helper, modes, enabled, width, height);
1304 		if (!ret)
1305 			DRM_ERROR("Unable to find initial modes\n");
1306 	}
1307 
1308 	DRM_DEBUG_KMS("picking CRTCs for %dx%d config\n", width, height);
1309 
1310 	drm_pick_crtcs(fb_helper, crtcs, modes, 0, width, height);
1311 
1312 	/* need to set the modesets up here for use later */
1313 	/* fill out the connector<->crtc mappings into the modesets */
1314 	for (i = 0; i < fb_helper->crtc_count; i++) {
1315 		modeset = &fb_helper->crtc_info[i].mode_set;
1316 		modeset->num_connectors = 0;
1317 	}
1318 
1319 	for (i = 0; i < fb_helper->connector_count; i++) {
1320 		struct drm_display_mode *mode = modes[i];
1321 		struct drm_fb_helper_crtc *fb_crtc = crtcs[i];
1322 		modeset = &fb_crtc->mode_set;
1323 
1324 		if (mode && fb_crtc) {
1325 			DRM_DEBUG_KMS("desired mode %s set on crtc %d\n",
1326 				      mode->name, fb_crtc->mode_set.crtc->base.id);
1327 			fb_crtc->desired_mode = mode;
1328 			if (modeset->mode)
1329 				drm_mode_destroy(dev, modeset->mode);
1330 			modeset->mode = drm_mode_duplicate(dev,
1331 							   fb_crtc->desired_mode);
1332 			modeset->connectors[modeset->num_connectors++] = fb_helper->connector_info[i]->connector;
1333 		}
1334 	}
1335 
1336 	kfree(crtcs);
1337 	kfree(modes);
1338 	kfree(enabled);
1339 }
1340 
1341 /**
1342  * drm_helper_initial_config - setup a sane initial connector configuration
1343  * @dev: DRM device
1344  *
1345  * LOCKING:
1346  * Called at init time, must take mode config lock.
1347  *
1348  * Scan the CRTCs and connectors and try to put together an initial setup.
1349  * At the moment, this is a cloned configuration across all heads with
1350  * a new framebuffer object as the backing store.
1351  *
1352  * RETURNS:
1353  * Zero if everything went ok, nonzero otherwise.
1354  */
1355 bool drm_fb_helper_initial_config(struct drm_fb_helper *fb_helper, int bpp_sel)
1356 {
1357 	struct drm_device *dev = fb_helper->dev;
1358 	int count = 0;
1359 
1360 	/* disable all the possible outputs/crtcs before entering KMS mode */
1361 	drm_helper_disable_unused_functions(fb_helper->dev);
1362 
1363 	drm_fb_helper_parse_command_line(fb_helper);
1364 
1365 	count = drm_fb_helper_probe_connector_modes(fb_helper,
1366 						    dev->mode_config.max_width,
1367 						    dev->mode_config.max_height);
1368 	/*
1369 	 * we shouldn't end up with no modes here.
1370 	 */
1371 	if (count == 0) {
1372 		printk(KERN_INFO "No connectors reported connected with modes\n");
1373 	}
1374 	drm_setup_crtcs(fb_helper);
1375 
1376 	return drm_fb_helper_single_fb_probe(fb_helper, bpp_sel);
1377 }
1378 EXPORT_SYMBOL(drm_fb_helper_initial_config);
1379 
1380 bool drm_fb_helper_hotplug_event(struct drm_fb_helper *fb_helper)
1381 {
1382 	int count = 0;
1383 	u32 max_width, max_height, bpp_sel;
1384 	bool bound = false, crtcs_bound = false;
1385 	struct drm_crtc *crtc;
1386 
1387 	if (!fb_helper->fb)
1388 		return false;
1389 
1390 	list_for_each_entry(crtc, &fb_helper->dev->mode_config.crtc_list, head) {
1391 		if (crtc->fb)
1392 			crtcs_bound = true;
1393 		if (crtc->fb == fb_helper->fb)
1394 			bound = true;
1395 	}
1396 
1397 	if (!bound && crtcs_bound) {
1398 		fb_helper->delayed_hotplug = true;
1399 		return false;
1400 	}
1401 	DRM_DEBUG_KMS("\n");
1402 
1403 	max_width = fb_helper->fb->width;
1404 	max_height = fb_helper->fb->height;
1405 	bpp_sel = fb_helper->fb->bits_per_pixel;
1406 
1407 	count = drm_fb_helper_probe_connector_modes(fb_helper, max_width,
1408 						    max_height);
1409 	drm_setup_crtcs(fb_helper);
1410 
1411 	return drm_fb_helper_single_fb_probe(fb_helper, bpp_sel);
1412 }
1413 EXPORT_SYMBOL(drm_fb_helper_hotplug_event);
1414 
1415