hc
2024-12-19 9370bb92b2d16684ee45cf24e879c93c509162da
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
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
/*
 * Copyright 2014 Freescale Semiconductor, Inc.
 *
 * FSL DCU Framebuffer driver
 *
 * SPDX-License-Identifier:    GPL-2.0+
 */
 
#include <asm/io.h>
#include <common.h>
#include <fsl_dcu_fb.h>
#include <i2c.h>
#include "div64.h"
#include "../common/diu_ch7301.h"
#include "ls1021aqds_qixis.h"
 
DECLARE_GLOBAL_DATA_PTR;
 
static int select_i2c_ch_pca9547(u8 ch)
{
   int ret;
 
   ret = i2c_write(I2C_MUX_PCA_ADDR_PRI, 0, 1, &ch, 1);
   if (ret) {
       puts("PCA: failed to select proper channel\n");
       return ret;
   }
 
   return 0;
}
 
unsigned int dcu_set_pixel_clock(unsigned int pixclock)
{
   unsigned long long div;
 
   div = (unsigned long long)(gd->bus_clk / 1000);
   div *= (unsigned long long)pixclock;
   do_div(div, 1000000000);
 
   return div;
}
 
int platform_dcu_init(unsigned int xres, unsigned int yres,
             const char *port,
             struct fb_videomode *dcu_fb_videomode)
{
   const char *name;
   unsigned int pixel_format;
   int ret;
   u8 ch;
 
   /* Mux I2C3+I2C4 as HSYNC+VSYNC */
   ret = i2c_read(CONFIG_SYS_I2C_QIXIS_ADDR, QIXIS_DCU_BRDCFG5,
              1, &ch, 1);
   if (ret) {
       printf("Error: failed to read I2C @%02x\n",
              CONFIG_SYS_I2C_QIXIS_ADDR);
       return ret;
   }
   ch &= 0x1F;
   ch |= 0xA0;
   ret = i2c_write(CONFIG_SYS_I2C_QIXIS_ADDR, QIXIS_DCU_BRDCFG5,
           1, &ch, 1);
   if (ret) {
       printf("Error: failed to write I2C @%02x\n",
              CONFIG_SYS_I2C_QIXIS_ADDR);
       return ret;
   }
 
   if (strncmp(port, "hdmi", 4) == 0) {
       unsigned long pixval;
 
       name = "HDMI";
 
       pixval = 1000000000 / dcu_fb_videomode->pixclock;
       pixval *= 1000;
 
       i2c_set_bus_num(CONFIG_SYS_I2C_DVI_BUS_NUM);
       select_i2c_ch_pca9547(I2C_MUX_CH_CH7301);
       diu_set_dvi_encoder(pixval);
       select_i2c_ch_pca9547(I2C_MUX_CH_DEFAULT);
   } else {
       return 0;
   }
 
   printf("DCU: Switching to %s monitor @ %ux%u\n", name, xres, yres);
 
   pixel_format = 32;
   fsl_dcu_init(xres, yres, pixel_format);
 
   return 0;
}