1
2
3
4
5
6
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
17DECLARE_GLOBAL_DATA_PTR;
18
19static 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
32unsigned 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
43int 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
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}
93