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