1 /*
2  * Copyright 2007-2011 Freescale Semiconductor, Inc.
3  * Authors: York Sun <yorksun@freescale.com>
4  *          Timur Tabi <timur@freescale.com>
5  *
6  * FSL DIU Framebuffer driver
7  *
8  * See file CREDITS for list of people who contributed to this
9  * project.
10  *
11  * This program is free software; you can redistribute it and/or
12  * modify it under the terms of the GNU General Public License as
13  * published by the Free Software Foundation; either version 2 of
14  * the License, or (at your option) any later version.
15  *
16  * This program is distributed in the hope that it will be useful,
17  * but WITHOUT ANY WARRANTY; without even the implied warranty of
18  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
19  * GNU General Public License for more details.
20  *
21  * You should have received a copy of the GNU General Public License
22  * along with this program; if not, write to the Free Software
23  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
24  * MA 02111-1307 USA
25  */
26 
27 #include <common.h>
28 #include <command.h>
29 #include <asm/io.h>
30 #include <fsl_diu_fb.h>
31 #include "../common/pixis.h"
32 
33 #define PX_BRDCFG0_DLINK	0x10
34 #define PX_BRDCFG0_DVISEL	0x08
35 
36 void diu_set_pixel_clock(unsigned int pixclock)
37 {
38 	volatile immap_t *immap = (immap_t *)CONFIG_SYS_IMMR;
39 	volatile ccsr_gur_t *gur = &immap->im_gur;
40 	volatile unsigned int *guts_clkdvdr = &gur->clkdvdr;
41 	unsigned long speed_ccb, temp, pixval;
42 
43 	speed_ccb = get_bus_freq(0);
44 	temp = 1000000000/pixclock;
45 	temp *= 1000;
46 	pixval = speed_ccb / temp;
47 	debug("DIU pixval = %lu\n", pixval);
48 
49 	/* Modify PXCLK in GUTS CLKDVDR */
50 	debug("DIU: Current value of CLKDVDR = 0x%08x\n", *guts_clkdvdr);
51 	temp = *guts_clkdvdr & 0x2000FFFF;
52 	*guts_clkdvdr = temp;				/* turn off clock */
53 	*guts_clkdvdr = temp | 0x80000000 | ((pixval & 0x1F) << 16);
54 	debug("DIU: Modified value of CLKDVDR = 0x%08x\n", *guts_clkdvdr);
55 }
56 
57 int platform_diu_init(unsigned int xres, unsigned int yres, const char *port)
58 {
59 	const char *name;
60 	int gamma_fix = 0;
61 	u32 pixel_format = 0x88883316;
62 	u8 temp;
63 
64 	temp = in_8(&pixis->brdcfg0);
65 
66 	if (strncmp(port, "dlvds", 5) == 0) {
67 		/* Dual link LVDS */
68 		gamma_fix = 1;
69 		temp &= ~(PX_BRDCFG0_DLINK | PX_BRDCFG0_DVISEL);
70 		name = "Dual-Link LVDS";
71 	} else if (strncmp(port, "lvds", 4) == 0) {
72 		/* Single link LVDS */
73 		temp = (temp & ~PX_BRDCFG0_DVISEL) | PX_BRDCFG0_DLINK;
74 		name = "Single-Link LVDS";
75 	} else {
76 		/* DVI */
77 		if (in_8(&pixis->ver) == 1)	/* Board version */
78 			pixel_format = 0x88882317;
79 		temp |= PX_BRDCFG0_DVISEL;
80 		name = "DVI";
81 	}
82 
83 	printf("DIU:   Switching to %s monitor @ %ux%u\n", name, xres, yres);
84 	out_8(&pixis->brdcfg0, temp);
85 
86 	return fsl_diu_init(xres, yres, pixel_format, gamma_fix);
87 }
88