board/freescale/mpc8610hpcd/mpc8610hpcd_diu.c

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