board/freescale/ls1021aqds/dcu.c

   1 /*
   2  * Copyright 2014 Freescale Semiconductor, Inc.
   3  *
   4  * FSL DCU Framebuffer driver
   5  *
   6  * SPDX-License-Identifier:     GPL-2.0+
   7  */
   8
   9 #include <asm/io.h>
  10 #include <common.h>
  11 #include <fsl_dcu_fb.h>
  12 #include <i2c.h>
  13 #include "div64.h"
  14 #include "../common/diu_ch7301.h"
  15 #include "ls1021aqds_qixis.h"
  16
  17 DECLARE_GLOBAL_DATA_PTR;
  18
  19 static int select_i2c_ch_pca9547(u8 ch)
  20 {
  21         int ret;
  22
  23         ret = i2c_write(I2C_MUX_PCA_ADDR_PRI, 0, 1, &ch, 1);
  24         if (ret) {
  25                 puts("PCA: failed to select proper channel\n");
  26                 return ret;
  27         }
  28
  29         return 0;
  30 }
  31
  32 unsigned int dcu_set_pixel_clock(unsigned int pixclock)
  33 {
  34         unsigned long long div;
  35
  36         div = (unsigned long long)(gd->bus_clk / 1000);
  37         div *= (unsigned long long)pixclock;
  38         do_div(div, 1000000000);
  39
  40         return div;
  41 }
  42
  43 int platform_dcu_init(unsigned int xres, unsigned int yres,
  44                       const char *port,
  45                       struct fb_videomode *dcu_fb_videomode)
  46 {
  47         const char *name;
  48         unsigned int pixel_format;
  49         int ret;
  50         u8 ch;
  51
  52         /* Mux I2C3+I2C4 as HSYNC+VSYNC */
  53         ret = i2c_read(CONFIG_SYS_I2C_QIXIS_ADDR, QIXIS_DCU_BRDCFG5,
  54                        1, &ch, 1);
  55         if (ret) {
  56                 printf("Error: failed to read I2C @%02x\n",
  57                        CONFIG_SYS_I2C_QIXIS_ADDR);
  58                 return ret;
  59         }
  60         ch &= 0x1F;
  61         ch |= 0xA0;
  62         ret = i2c_write(CONFIG_SYS_I2C_QIXIS_ADDR, QIXIS_DCU_BRDCFG5,
  63                         1, &ch, 1);
  64         if (ret) {
  65                 printf("Error: failed to write I2C @%02x\n",
  66                        CONFIG_SYS_I2C_QIXIS_ADDR);
  67                 return ret;
  68         }
  69
  70         if (strncmp(port, "hdmi", 4) == 0) {
  71                 unsigned long pixval;
  72
  73                 name = "HDMI";
  74
  75                 pixval = 1000000000 / dcu_fb_videomode->pixclock;
  76                 pixval *= 1000;
  77
  78                 i2c_set_bus_num(CONFIG_SYS_I2C_DVI_BUS_NUM);
  79                 select_i2c_ch_pca9547(I2C_MUX_CH_CH7301);
  80                 diu_set_dvi_encoder(pixval);
  81                 select_i2c_ch_pca9547(I2C_MUX_CH_DEFAULT);
  82         } else {
  83                 return 0;
  84         }
  85
  86         printf("DCU: Switching to %s monitor @ %ux%u\n", name, xres, yres);
  87
  88         pixel_format = 32;
  89         fsl_dcu_init(xres, yres, pixel_format);
  90
  91         return 0;
  92 }