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 * SPDX-License-Identifier: GPL-2.0+ 9 */ 10 11 #include <common.h> 12 #include <command.h> 13 #include <asm/io.h> 14 #include <fsl_diu_fb.h> 15 #include "../common/pixis.h" 16 17 #define PX_BRDCFG0_DLINK 0x10 18 #define PX_BRDCFG0_DVISEL 0x08 19 20 void diu_set_pixel_clock(unsigned int pixclock) 21 { 22 volatile immap_t *immap = (immap_t *)CONFIG_SYS_IMMR; 23 volatile ccsr_gur_t *gur = &immap->im_gur; 24 volatile unsigned int *guts_clkdvdr = &gur->clkdvdr; 25 unsigned long speed_ccb, temp, pixval; 26 27 speed_ccb = get_bus_freq(0); 28 temp = 1000000000/pixclock; 29 temp *= 1000; 30 pixval = speed_ccb / temp; 31 debug("DIU pixval = %lu\n", pixval); 32 33 /* Modify PXCLK in GUTS CLKDVDR */ 34 debug("DIU: Current value of CLKDVDR = 0x%08x\n", *guts_clkdvdr); 35 temp = *guts_clkdvdr & 0x2000FFFF; 36 *guts_clkdvdr = temp; /* turn off clock */ 37 *guts_clkdvdr = temp | 0x80000000 | ((pixval & 0x1F) << 16); 38 debug("DIU: Modified value of CLKDVDR = 0x%08x\n", *guts_clkdvdr); 39 } 40 41 int platform_diu_init(unsigned int xres, unsigned int yres, const char *port) 42 { 43 const char *name; 44 int gamma_fix = 0; 45 u32 pixel_format = 0x88883316; 46 u8 temp; 47 48 temp = in_8(&pixis->brdcfg0); 49 50 if (strncmp(port, "dlvds", 5) == 0) { 51 /* Dual link LVDS */ 52 gamma_fix = 1; 53 temp &= ~(PX_BRDCFG0_DLINK | PX_BRDCFG0_DVISEL); 54 name = "Dual-Link LVDS"; 55 } else if (strncmp(port, "lvds", 4) == 0) { 56 /* Single link LVDS */ 57 temp = (temp & ~PX_BRDCFG0_DVISEL) | PX_BRDCFG0_DLINK; 58 name = "Single-Link LVDS"; 59 } else { 60 /* DVI */ 61 if (in_8(&pixis->ver) == 1) /* Board version */ 62 pixel_format = 0x88882317; 63 temp |= PX_BRDCFG0_DVISEL; 64 name = "DVI"; 65 } 66 67 printf("DIU: Switching to %s monitor @ %ux%u\n", name, xres, yres); 68 out_8(&pixis->brdcfg0, temp); 69 70 return fsl_diu_init(xres, yres, pixel_format, gamma_fix); 71 } 72