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