ronnie
2022-10-14 1504bb53e29d3d46222c0b3ea994fc494b48e153
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
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
/*
 * Allwinner SoCs display driver.
 *
 * Copyright (C) 2016 Allwinner.
 *
 * This file is licensed under the terms of the GNU General Public
 * License version 2.  This program is licensed "as is" without any
 * warranty of any kind, whether express or implied.
 */
 
#include "lt070me05000.h"
 
static void LCD_power_on(u32 sel);
static void LCD_power_off(u32 sel);
static void LCD_bl_open(u32 sel);
static void LCD_bl_close(u32 sel);
 
static void LCD_panel_init(u32 sel);
static void LCD_panel_exit(u32 sel);
 
static u8 const mipi_dcs_pixel_format[4] = { 0x77, 0x66, 0x66, 0x55 };
 
#define panel_reset(val) sunxi_lcd_gpio_set_value(sel, 1, val)
#define power_en(val)  sunxi_lcd_gpio_set_value(sel, 0, val)
 
static void LCD_cfg_panel_info(struct panel_extend_para *info)
{
   u32 i = 0, j = 0;
   u32 items;
   u8 lcd_gamma_tbl[][2] = {
       /* {input value, corrected value} */
       {0, 0},
       {15, 15},
       {30, 30},
       {45, 45},
       {60, 60},
       {75, 75},
       {90, 90},
       {105, 105},
       {120, 120},
       {135, 135},
       {150, 150},
       {165, 165},
       {180, 180},
       {195, 195},
       {210, 210},
       {225, 225},
       {240, 240},
       {255, 255},
   };
 
   u32 lcd_cmap_tbl[2][3][4] = {
       {
        {LCD_CMAP_G0, LCD_CMAP_B1, LCD_CMAP_G2, LCD_CMAP_B3},
        {LCD_CMAP_B0, LCD_CMAP_R1, LCD_CMAP_B2, LCD_CMAP_R3},
        {LCD_CMAP_R0, LCD_CMAP_G1, LCD_CMAP_R2, LCD_CMAP_G3},
        },
       {
        {LCD_CMAP_B3, LCD_CMAP_G2, LCD_CMAP_B1, LCD_CMAP_G0},
        {LCD_CMAP_R3, LCD_CMAP_B2, LCD_CMAP_R1, LCD_CMAP_B0},
        {LCD_CMAP_G3, LCD_CMAP_R2, LCD_CMAP_G1, LCD_CMAP_R0},
        },
   };
 
   items = sizeof(lcd_gamma_tbl) / 2;
   for (i = 0; i < items - 1; i++) {
       u32 num = lcd_gamma_tbl[i + 1][0] - lcd_gamma_tbl[i][0];
 
       for (j = 0; j < num; j++) {
           u32 value = 0;
 
           value =
               lcd_gamma_tbl[i][1] +
               ((lcd_gamma_tbl[i + 1][1] -
                 lcd_gamma_tbl[i][1]) * j) / num;
           info->lcd_gamma_tbl[lcd_gamma_tbl[i][0] + j] =
               (value << 16) + (value << 8) + value;
       }
   }
   info->lcd_gamma_tbl[255] =
       (lcd_gamma_tbl[items - 1][1] << 16) +
       (lcd_gamma_tbl[items - 1][1] << 8) + lcd_gamma_tbl[items - 1][1];
 
   memcpy(info->lcd_cmap_tbl, lcd_cmap_tbl, sizeof(lcd_cmap_tbl));
 
}
 
static s32 LCD_open_flow(u32 sel)
{
   /* open lcd power, and delay 50ms */
   LCD_OPEN_FUNC(sel, LCD_power_on, 20);
   /* open lcd power, than delay 200ms */
   LCD_OPEN_FUNC(sel, LCD_panel_init, 10);
   /* open lcd controller, and delay 100ms */
   LCD_OPEN_FUNC(sel, sunxi_lcd_tcon_enable, 20);
   /* open lcd backlight, and delay 0ms */
   LCD_OPEN_FUNC(sel, LCD_bl_open, 0);
 
   return 0;
}
 
static s32 LCD_close_flow(u32 sel)
{
   /* close lcd backlight, and delay 0ms */
   LCD_CLOSE_FUNC(sel, LCD_bl_close, 0);
   /* close lcd controller, and delay 0ms */
   LCD_CLOSE_FUNC(sel, sunxi_lcd_tcon_disable, 0);
   /* open lcd power, than delay 200ms */
   LCD_CLOSE_FUNC(sel, LCD_panel_exit, 200);
   /* close lcd power, and delay 500ms */
   LCD_CLOSE_FUNC(sel, LCD_power_off, 500);
 
   return 0;
}
 
static void LCD_power_on(u32 sel)
{
   /* config lcd_power pin to open lcd power */
   sunxi_lcd_power_enable(sel, 0);
   sunxi_lcd_delay_ms(5);
   /* config lcd_power pin to open lcd power0 */
   sunxi_lcd_power_enable(sel, 1);
   sunxi_lcd_delay_ms(5);
   /* config lcd_power pin to open lcd power2 */
   sunxi_lcd_power_enable(sel, 2);
   sunxi_lcd_delay_ms(5);
   power_en(1);
   sunxi_lcd_delay_ms(20);
   panel_reset(1);
   sunxi_lcd_delay_ms(5);
   sunxi_lcd_pin_cfg(sel, 1);
}
 
static void LCD_power_off(u32 sel)
{
   sunxi_lcd_pin_cfg(sel, 0);
   power_en(0);
   sunxi_lcd_delay_ms(20);
   panel_reset(0);
   sunxi_lcd_delay_ms(5);
   /* config lcd_power pin to close lcd power2 */
   sunxi_lcd_power_disable(sel, 2);
   sunxi_lcd_delay_ms(5);
   /* config lcd_power pin to close lcd power1 */
   sunxi_lcd_power_disable(sel, 1);
   sunxi_lcd_delay_ms(5);
   /* config lcd_power pin to close lcd power */
   sunxi_lcd_power_disable(sel, 0);
}
 
static void LCD_bl_open(u32 sel)
{
   sunxi_lcd_pwm_enable(sel);
   /* config lcd_bl_en pin to open lcd backlight */
   sunxi_lcd_backlight_enable(sel);
}
 
static void LCD_bl_close(u32 sel)
{
   /* config lcd_bl_en pin to close lcd backlight */
   sunxi_lcd_backlight_disable(sel);
   sunxi_lcd_pwm_disable(sel);
}
 
static void LCD_panel_init(u32 sel)
{
   struct disp_panel_para *panel_info =
       kmalloc(sizeof(struct disp_panel_para), GFP_KERNEL | __GFP_ZERO);
   u32 bright = 0;
   u8 para[9];
 
   bsp_disp_get_panel_info(sel, panel_info);
   bright = bsp_disp_lcd_get_bright(sel);
 
   sunxi_lcd_dsi_clk_enable(sel);
   sunxi_lcd_delay_ms(20);
   sunxi_lcd_dsi_dcs_write_0para(sel, DSI_DCS_SOFT_RESET);
   sunxi_lcd_delay_ms(10);
   sunxi_lcd_dsi_gen_write_1para(sel, 0xb0, 0x00);
   sunxi_lcd_dsi_gen_write_5para(sel, 0xb3, 0x04, 0x08, 0x00, 0x22, 0x00);
   sunxi_lcd_dsi_gen_write_1para(sel, 0xb4, 0x0c);
   sunxi_lcd_dsi_gen_write_2para(sel, 0xb6, 0x3a, 0xd3);
   sunxi_lcd_dsi_dcs_write_1para(sel, 0x51, bright);
   sunxi_lcd_dsi_dcs_write_1para(sel, 0x53, 0x2c);
   sunxi_lcd_dsi_dcs_write_1para(sel, DSI_DCS_SET_PIXEL_FORMAT, 0x77);
   sunxi_lcd_dsi_dcs_write_4para(sel, DSI_DCS_SET_COLUMN_ADDRESS, 0x00,
                     0x00, 0x04, 0xaf);
   sunxi_lcd_dsi_dcs_write_4para(sel, DSI_DCS_SET_PAGE_ADDRESS, 0x00, 0x00,
                     0x07, 0x7f);
   sunxi_lcd_dsi_dcs_write_0para(sel, DSI_DCS_EXIT_SLEEP_MODE);
   sunxi_lcd_delay_ms(120);
   sunxi_lcd_dsi_dcs_write_0para(sel, DSI_DCS_SET_DISPLAY_ON);
 
   sunxi_lcd_dsi_gen_write_5para(sel, 0xb3, 0x14, 0x08, 0x00, 0x22, 0x00);
 
   sunxi_lcd_dsi_gen_write_1para(sel, 0xd6, 0x01);
   para[0] = 0x31;
   para[1] = 0xf7;
   para[2] = 0x80;
   para[3] = 0x00;
   para[4] = panel_info->lcd_vbp - 1;
   para[5] = 0x00;
   para[6] = 0x08;
   para[7] = 0x00;
   para[8] = 0x00;
   sunxi_lcd_dsi_gen_write(sel, 0xc2, para, 9);
 
   kfree(panel_info);
}
 
static void LCD_panel_exit(u32 sel)
{
   sunxi_lcd_dsi_dcs_write_0para(sel, DSI_DCS_SET_DISPLAY_OFF);
   sunxi_lcd_delay_ms(20);
   sunxi_lcd_dsi_dcs_write_0para(sel, DSI_DCS_ENTER_SLEEP_MODE);
   sunxi_lcd_delay_ms(80);
}
 
/* sel: 0:lcd0; 1:lcd1 */
static s32 LCD_user_defined_func(u32 sel, u32 para1, u32 para2, u32 para3)
{
   return 0;
}
 
/* sel: 0:lcd0; 1:lcd1 */
static s32 LCD_set_bright(u32 sel, u32 bright)
{
   sunxi_lcd_dsi_dcs_write_1para(sel, 0x51, bright);
   return 0;
}
 
struct __lcd_panel lt070me05000_panel = {
   /* panel driver name, must mach the lcd_drv_name in sys_config.fex */
   .name = "lt070me05000",
   .func = {
        .cfg_panel_info = LCD_cfg_panel_info,
        .cfg_open_flow = LCD_open_flow,
        .cfg_close_flow = LCD_close_flow,
        .lcd_user_defined_func = LCD_user_defined_func,
        .set_bright = LCD_set_bright,
        }
   ,
};