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
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
|
#include <mach/mt_typedefs.h>
#include <linux/types.h>
#include "primary_display.h"
#include "ddp_hal.h"
#include "disp_drv_log.h"
#include <linux/disp_assert_layer.h>
#include <linux/semaphore.h>
#include <linux/mutex.h>
#include "ddp_mmp.h"
#include "disp_session.h"
///common part
#define DAL_BPP (2)
#define DAL_WIDTH (DISP_GetScreenWidth())
#define DAL_HEIGHT (DISP_GetScreenHeight())
//#ifdef CONFIG_MTK_FB_SUPPORT_ASSERTION_LAYER
#include <linux/string.h>
#include <linux/semaphore.h>
#include <asm/cacheflush.h>
#include <linux/module.h>
#include "mtkfb_console.h"
#include "disp_drv_platform.h"
// ---------------------------------------------------------------------------
#define DAL_FORMAT (DISP_FORMAT_RGB565)
#define DAL_BG_COLOR (dal_bg_color)
#define DAL_FG_COLOR (dal_fg_color)
#define RGB888_To_RGB565(x) ((((x) & 0xF80000) >> 8) | \
(((x) & 0x00FC00) >> 5) | \
(((x) & 0x0000F8) >> 3))
#define MAKE_TWO_RGB565_COLOR(high, low) (((low) << 16) | (high))
#define DAL_LOCK() \
do { \
if (down_interruptible(&dal_sem)) { \
pr_warn("DISP/DAL " "Can't get semaphore in %s()\n", \
__func__); \
return DAL_STATUS_LOCK_FAIL; \
} \
} while (0)
#define DAL_UNLOCK() \
do { \
up(&dal_sem); \
} while (0)
#define DAL_CHECK_MFC_RET(expr) \
do { \
MFC_STATUS ret = (expr); \
if (MFC_STATUS_OK != ret) { \
pr_warn("DISP/DAL " "Warning: call MFC_XXX function failed " \
"in %s(), line: %d, ret: %x\n", \
__func__, __LINE__, ret); \
return ret; \
} \
} while (0)
#define DAL_CHECK_DISP_RET(expr) \
do { \
DISP_STATUS ret = (expr); \
if (DISP_STATUS_OK != ret) { \
pr_warn("DISP/DAL " "Warning: call DISP_XXX function failed " \
"in %s(), line: %d, ret: %x\n", \
__func__, __LINE__, ret); \
return ret; \
} \
} while (0)
#define DAL_LOG(fmt, arg...) \
do { \
pr_info("DISP/DAL " fmt, ##arg); \
}while (0)
// ---------------------------------------------------------------------------
static MFC_HANDLE mfc_handle = NULL;
static void *dal_fb_addr = NULL;
static unsigned long dal_fb_pa = 0;
unsigned int isAEEEnabled = 0;
extern BOOL is_early_suspended;
extern struct semaphore sem_early_suspend;
extern struct mutex disp_trigger_lock;
//static BOOL dal_shown = FALSE;
BOOL dal_shown = FALSE;
static BOOL dal_enable_when_resume = FALSE;
static BOOL dal_disable_when_resume = FALSE;
static unsigned int dal_fg_color = RGB888_To_RGB565(DAL_COLOR_WHITE);
static unsigned int dal_bg_color = RGB888_To_RGB565(DAL_COLOR_RED);
extern struct mutex OverlaySettingMutex;
extern atomic_t OverlaySettingDirtyFlag;
extern atomic_t OverlaySettingApplied;
extern OVL_CONFIG_STRUCT cached_layer_config[DDP_OVL_LAYER_MUN];
extern disp_session_input_config* captured_session_input;
//DECLARE_MUTEX(dal_sem);
DEFINE_SEMAPHORE(dal_sem);
static char dal_print_buffer[1024];
// ---------------------------------------------------------------------------
UINT32 DAL_GetLayerSize(void)
{
// xuecheng, avoid lcdc read buffersize+1 issue
return DAL_WIDTH * DAL_HEIGHT * DAL_BPP + 4096;
}
static DAL_STATUS DAL_SetRedScreen(UINT32 *addr)
{
UINT32 i;
const UINT32 BG_COLOR = MAKE_TWO_RGB565_COLOR(DAL_BG_COLOR, DAL_BG_COLOR);
for(i = 0; i < DAL_GetLayerSize() / sizeof(UINT32); ++ i) {
*addr ++ = BG_COLOR;
}
return DAL_STATUS_OK;
}
DAL_STATUS DAL_SetScreenColor(DAL_COLOR color)
{
#if 1
UINT32 i;
UINT32 size;
UINT32 BG_COLOR;
MFC_CONTEXT *ctxt =NULL;
UINT32 offset;
unsigned int *addr;
color=RGB888_To_RGB565(color);
BG_COLOR = MAKE_TWO_RGB565_COLOR(color, color);
ctxt = (MFC_CONTEXT *)mfc_handle;
if(!ctxt)
return DAL_STATUS_FATAL_ERROR;
if(ctxt->screen_color==color)
return DAL_STATUS_OK;
offset = MFC_Get_Cursor_Offset(mfc_handle);
addr=(unsigned int *)(ctxt->fb_addr+offset);
size= DAL_GetLayerSize()-offset;
for(i = 0; i < size/ sizeof(UINT32); ++ i)
{
*addr ++ = BG_COLOR;
}
ctxt->screen_color=color;
return DAL_STATUS_OK;
}
DAL_STATUS DAL_Init(unsigned long layerVA, unsigned long layerPA)
{
printk("%s, layerVA=0x%lx, layerPA=0x%lx\n", __func__, layerVA, layerPA);
dal_fb_addr = (void *)layerVA;
dal_fb_pa = layerPA;
DAL_CHECK_MFC_RET(MFC_Open(&mfc_handle, dal_fb_addr,
DAL_WIDTH, DAL_HEIGHT, DAL_BPP,
DAL_FG_COLOR, DAL_BG_COLOR));
//DAL_Clean();
DAL_SetScreenColor(DAL_COLOR_RED);
return DAL_STATUS_OK;
}
DAL_STATUS DAL_SetColor(unsigned int fgColor, unsigned int bgColor)
{
if (NULL == mfc_handle)
return DAL_STATUS_NOT_READY;
DAL_LOCK();
dal_fg_color = RGB888_To_RGB565(fgColor);
dal_bg_color = RGB888_To_RGB565(bgColor);
DAL_CHECK_MFC_RET(MFC_SetColor(mfc_handle, dal_fg_color, dal_bg_color));
DAL_UNLOCK();
return DAL_STATUS_OK;
}
DAL_STATUS DAL_Dynamic_Change_FB_Layer(unsigned int isAEEEnabled)
{
return DAL_STATUS_OK;
}
DAL_STATUS DAL_Clean(void)
{
const UINT32 BG_COLOR = MAKE_TWO_RGB565_COLOR(DAL_BG_COLOR, DAL_BG_COLOR);
DAL_STATUS ret = DAL_STATUS_OK;
static int dal_clean_cnt = 0;
MFC_CONTEXT *ctxt = (MFC_CONTEXT *)mfc_handle;
DISPFUNC();
if (NULL == mfc_handle)
return DAL_STATUS_NOT_READY;
MMProfileLogEx(ddp_mmp_get_events()->dal_clean, MMProfileFlagStart, 0, 0);
DAL_LOCK();
DAL_CHECK_MFC_RET(MFC_ResetCursor(mfc_handle));
ctxt->screen_color=0;
DAL_SetScreenColor(DAL_COLOR_RED);
//TODO: if dal_shown=false, and 3D enabled, mtkfb may disable UI layer, please modify 3D driver
if(isAEEEnabled==1)
{
disp_session_input_config *session_input;
disp_input_config input;
int layer_id;
session_input = &captured_session_input[DISP_SESSION_PRIMARY - 1];
session_input->setter = SESSION_USER_AEE;
session_input->config_layer_num = 4;
layer_id = primary_display_get_option("ASSERT_LAYER");
input = session_input->config[layer_id];
memset((void*)&input, 0, sizeof(input));
input.src_phy_addr = (unsigned int)dal_fb_pa;
input.layer_id = primary_display_get_option("ASSERT_LAYER");
input.layer_enable= 0;
input.src_offset_x = 0;
input.src_offset_y = 0;
input.src_width = DAL_WIDTH;
input.src_height = DAL_HEIGHT;
input.tgt_offset_x = 0;
input.tgt_offset_y = 0;
input.tgt_width = DAL_WIDTH;
input.tgt_height = DAL_HEIGHT;
input.alpha = 0x80;
input.alpha_enable = 1;
input.next_buff_idx = -1;
input.src_pitch = DAL_WIDTH;
input.src_fmt = DAL_FORMAT;
input.next_buff_idx = -1;
captured_session_input[DISP_SESSION_PRIMARY - 1].config[input.layer_id] = input;
ret = primary_display_config_input_multiple(session_input);
// DAL disable, switch UI layer to default layer 3
printk("[DDP]* isAEEEnabled from 1 to 0, %d \n", dal_clean_cnt++);
isAEEEnabled = 0;
DAL_Dynamic_Change_FB_Layer(isAEEEnabled); // restore UI layer to DEFAULT_UI_LAYER
}
End:
DAL_UNLOCK();
MMProfileLogEx(ddp_mmp_get_events()->dal_clean, MMProfileFlagEnd, 0, 0);
return ret;
}
int is_DAL_Enabled(void)
{
int ret = 0;
DAL_LOCK();
ret = isAEEEnabled;
DAL_UNLOCK();
return ret;
}
unsigned long get_Assert_Layer_PA(void)
{
return dal_fb_pa;
}
DAL_STATUS DAL_Printf(const char *fmt, ...)
{
va_list args;
uint i;
DAL_STATUS ret = DAL_STATUS_OK;
disp_session_input_config *session_input;
disp_input_config input;
int layer_id;
DISPFUNC();
if (NULL == mfc_handle)
return DAL_STATUS_NOT_READY;
if (NULL == fmt)
return DAL_STATUS_INVALID_ARGUMENT;
MMProfileLogEx(ddp_mmp_get_events()->dal_printf, MMProfileFlagStart, 0, 0);
DAL_LOCK();
if(isAEEEnabled==0)
{
printk("[DDP] isAEEEnabled from 0 to 1, ASSERT_LAYER=%d, dal_fb_pa %lx\n",
primary_display_get_option("ASSERT_LAYER"), dal_fb_pa);
isAEEEnabled = 1;
DAL_Dynamic_Change_FB_Layer(isAEEEnabled); // default_ui_ layer coniig to changed_ui_layer
DAL_CHECK_MFC_RET(MFC_Open(&mfc_handle, dal_fb_addr,
DAL_WIDTH, DAL_HEIGHT, DAL_BPP,
DAL_FG_COLOR, DAL_BG_COLOR));
session_input = &captured_session_input[DISP_SESSION_PRIMARY - 1];
session_input->setter = SESSION_USER_AEE;
session_input->config_layer_num = 4;
layer_id = primary_display_get_option("ASSERT_LAYER");
input = session_input->config[layer_id];
memset((void*)&input, 0, sizeof(input));
input.src_phy_addr = (unsigned int)dal_fb_pa;
input.layer_id = primary_display_get_option("ASSERT_LAYER");
input.layer_enable= 1;
input.src_offset_x = 0;
input.src_offset_y = 0;
input.src_width = DAL_WIDTH;
input.src_height = DAL_HEIGHT;
input.tgt_offset_x = 0;
input.tgt_offset_y = 0;
input.tgt_width = DAL_WIDTH;
input.tgt_height = DAL_HEIGHT;
input.alpha = 0x80;
input.alpha_enable = 1;
input.next_buff_idx = -1;
input.src_pitch = DAL_WIDTH;
input.src_fmt = DAL_FORMAT;
input.next_buff_idx = -1;
captured_session_input[DISP_SESSION_PRIMARY - 1].config[input.layer_id] = input;
ret = primary_display_config_input_multiple(session_input);
}
va_start (args, fmt);
i = vsprintf(dal_print_buffer, fmt, args);
BUG_ON(i>=ARRAY_SIZE(dal_print_buffer));
va_end (args);
DAL_CHECK_MFC_RET(MFC_Print(mfc_handle, dal_print_buffer));
flush_cache_all();
if (!dal_shown)
{
dal_shown = TRUE;
}
mutex_lock(&disp_trigger_lock);
ret = primary_display_trigger(0, NULL, 0);
mutex_unlock(&disp_trigger_lock);
End:
DAL_UNLOCK();
MMProfileLogEx(ddp_mmp_get_events()->dal_printf, MMProfileFlagEnd, 0, 0);
return ret;
}
DAL_STATUS DAL_OnDispPowerOn(void)
{
return DAL_STATUS_OK;
}
// ##########################################################################
// !CONFIG_MTK_FB_SUPPORT_ASSERTION_LAYER
// ##########################################################################
#else
unsigned int isAEEEnabled = 0;
UINT32 DAL_GetLayerSize(void)
{
// xuecheng, avoid lcdc read buffersize+1 issue
return DAL_WIDTH * DAL_HEIGHT * DAL_BPP + 4096;
}
DAL_STATUS DAL_Init(UINT32 layerVA, UINT32 layerPA)
{
NOT_REFERENCED(layerVA);
NOT_REFERENCED(layerPA);
return DAL_STATUS_OK;
}
DAL_STATUS DAL_SetColor(unsigned int fgColor, unsigned int bgColor)
{
NOT_REFERENCED(fgColor);
NOT_REFERENCED(bgColor);
return DAL_STATUS_OK;
}
DAL_STATUS DAL_Clean(void)
{
printk("[MTKFB_DAL] DAL_Clean is not implemented\n");
return DAL_STATUS_OK;
}
DAL_STATUS DAL_Printf(const char *fmt, ...)
{
NOT_REFERENCED(fmt);
printk("[MTKFB_DAL] DAL_Printf is not implemented\n");
return DAL_STATUS_OK;
}
DAL_STATUS DAL_OnDispPowerOn(void)
{
return DAL_STATUS_OK;
}
DAL_STATUS DAL_SetScreenColor(DAL_COLOR color)
{
return DAL_STATUS_OK;
}
#endif // CONFIG_MTK_FB_SUPPORT_ASSERTION_LAYER
EXPORT_SYMBOL(DAL_SetColor);
EXPORT_SYMBOL(DAL_SetScreenColor);
EXPORT_SYMBOL(DAL_Printf);
EXPORT_SYMBOL(DAL_Clean);
#ifdef DAL_LOWMEMORY_ASSERT
EXPORT_SYMBOL(DAL_LowMemoryOn);
EXPORT_SYMBOL(DAL_LowMemoryOff);
#endif
|
