2092 lines
55 KiB
C
2092 lines
55 KiB
C
|
/* SPDX-License-Identifier: GPL-2.0 */
|
||
|
/*
|
||
|
* Copyright (c) 2019 MediaTek Inc.
|
||
|
*/
|
||
|
|
||
|
#include <linux/string.h>
|
||
|
#include <linux/time.h>
|
||
|
#include <linux/uaccess.h>
|
||
|
#include <linux/fb.h>
|
||
|
#include <linux/vmalloc.h>
|
||
|
#include <linux/sched.h>
|
||
|
#if IS_ENABLED(CONFIG_DEBUG_FS)
|
||
|
#include <linux/debugfs.h>
|
||
|
#endif
|
||
|
|
||
|
#if IS_ENABLED(CONFIG_PROC_FS)
|
||
|
#include <linux/proc_fs.h>
|
||
|
#endif
|
||
|
#include <linux/wait.h>
|
||
|
#include <linux/time.h>
|
||
|
#include <linux/delay.h>
|
||
|
#include <linux/fs.h>
|
||
|
#include <linux/file.h>
|
||
|
#include <linux/sched.h>
|
||
|
#include "ddp_m4u.h"
|
||
|
#include "disp_drv_log.h"
|
||
|
#include "mtkfb.h"
|
||
|
#include "debug.h"
|
||
|
#include "lcm_drv.h"
|
||
|
#include "ddp_ovl.h"
|
||
|
#include "ddp_path.h"
|
||
|
#include "ddp_reg.h"
|
||
|
#include "primary_display.h"
|
||
|
#include "mtk_disp_mgr.h"
|
||
|
#include "display_recorder.h"
|
||
|
#ifdef CONFIG_MTK_LEGACY
|
||
|
#include <mach/mt_gpio.h>
|
||
|
#include <cust_gpio_usage.h>
|
||
|
#else
|
||
|
#include "disp_dts_gpio.h"
|
||
|
#endif
|
||
|
#include "mtkfb_fence.h"
|
||
|
#include "disp_helper.h"
|
||
|
#include "ddp_manager.h"
|
||
|
#include "ddp_log.h"
|
||
|
#include "ddp_dsi.h"
|
||
|
|
||
|
#include "cmdq_def.h"
|
||
|
#include "cmdq_record.h"
|
||
|
#include "cmdq_reg.h"
|
||
|
#include "cmdq_core.h"
|
||
|
#include "disp_lowpower.h"
|
||
|
#include "disp_arr.h"
|
||
|
#include "disp_recovery.h"
|
||
|
#include "disp_partial.h"
|
||
|
#include "disp_drv_platform.h"
|
||
|
#if defined(MTK_FB_ION_SUPPORT)
|
||
|
#include "mtk_ion.h"
|
||
|
#include "ion_drv.h"
|
||
|
#include "ion.h"
|
||
|
#endif
|
||
|
#include "layering_rule.h"
|
||
|
#include "ddp_clkmgr.h"
|
||
|
#include "ddp_disp_bdg.h"
|
||
|
|
||
|
#if IS_ENABLED(CONFIG_DEBUG_FS)
|
||
|
static struct dentry *mtkfb_dbgfs;
|
||
|
#endif
|
||
|
|
||
|
#if IS_ENABLED(CONFIG_PROC_FS)
|
||
|
static struct proc_dir_entry *mtkfb_procfs;
|
||
|
static struct proc_dir_entry *disp_lowpower_proc;
|
||
|
#endif
|
||
|
|
||
|
unsigned int g_mobilelog;
|
||
|
int bypass_blank;
|
||
|
int lcm_mode_status;
|
||
|
int layer_layout_allow_non_continuous;
|
||
|
/* Boundary of enter screen idle */
|
||
|
unsigned long long idle_check_interval = 50;
|
||
|
/* modify rdma threshold for debug */
|
||
|
int dbg_ultlow, dbg_ulthigh, dbg_prehigh, dbg_urg_low, dbg_urg_high;
|
||
|
|
||
|
/* hrt */
|
||
|
unsigned long long hrt_high, hrt_low;
|
||
|
int hrt_show_flag;
|
||
|
|
||
|
struct BMP_FILE_HEADER {
|
||
|
UINT16 bfType;
|
||
|
UINT32 bfSize;
|
||
|
UINT16 bfReserved1;
|
||
|
UINT16 bfReserved2;
|
||
|
UINT32 bfOffBits;
|
||
|
};
|
||
|
|
||
|
struct BMP_INFO_HEADER {
|
||
|
UINT32 biSize;
|
||
|
UINT32 biWidth;
|
||
|
UINT32 biHeight;
|
||
|
UINT16 biPlanes;
|
||
|
UINT16 biBitCount;
|
||
|
UINT32 biCompression;
|
||
|
UINT32 biSizeImage;
|
||
|
UINT32 biXPelsPerMeter;
|
||
|
UINT32 biYPelsPerMeter;
|
||
|
UINT32 biClrUsed;
|
||
|
UINT32 biClrImportant;
|
||
|
};
|
||
|
|
||
|
/*********************** layer information statistic *********************/
|
||
|
#define STATISTIC_MAX_LAYERS 20
|
||
|
struct layer_statistic {
|
||
|
unsigned long total_frame_cnt;
|
||
|
unsigned long cnt_by_layers[STATISTIC_MAX_LAYERS];
|
||
|
unsigned long cnt_by_layers_with_ext[STATISTIC_MAX_LAYERS];
|
||
|
unsigned long cnt_by_layers_with_arm_ext[STATISTIC_MAX_LAYERS];
|
||
|
};
|
||
|
static struct layer_statistic layer_stat;
|
||
|
static int layer_statistic_enable;
|
||
|
|
||
|
static int _is_overlap(unsigned int x1, unsigned int y1,
|
||
|
unsigned int w1, unsigned int h1, unsigned int x2,
|
||
|
unsigned int y2, unsigned int w2, unsigned int h2)
|
||
|
{
|
||
|
if (x2 >= x1 + w1 || x1 >= x2 + w2)
|
||
|
return 0;
|
||
|
if (y2 >= y1 + h1 || y1 >= y2 + h2)
|
||
|
return 0;
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
static int layer_is_overlap(struct disp_frame_cfg_t *cfg,
|
||
|
int idx, int from, int to)
|
||
|
{
|
||
|
int i;
|
||
|
|
||
|
for (i = from; i <= to; i++) {
|
||
|
if (_is_overlap(cfg->input_cfg[idx].tgt_offset_x,
|
||
|
cfg->input_cfg[idx].tgt_offset_y,
|
||
|
cfg->input_cfg[idx].src_width,
|
||
|
cfg->input_cfg[idx].src_height,
|
||
|
cfg->input_cfg[i].tgt_offset_x,
|
||
|
cfg->input_cfg[i].tgt_offset_y,
|
||
|
cfg->input_cfg[i].src_width,
|
||
|
cfg->input_cfg[i].src_height))
|
||
|
return 1;
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
|
||
|
static int calc_layer_num_with_arm_ext(struct disp_frame_cfg_t *cfg)
|
||
|
{
|
||
|
int ovl_phy_num[2] = {4, 2};
|
||
|
int ovl_ext_num[2] = {3, 3};
|
||
|
int ovl_idx = 0;
|
||
|
int i, cur_phy_num, cur_ext_num;
|
||
|
int cur_phy_idx_in_cfg;
|
||
|
int total_phy_layer = 0;
|
||
|
|
||
|
cur_phy_num = 0;
|
||
|
cur_ext_num = 0;
|
||
|
cur_phy_idx_in_cfg = 0;
|
||
|
for (i = 0; i < cfg->input_layer_num; i++) {
|
||
|
int is_overlap;
|
||
|
|
||
|
if (!cfg->input_cfg[i].layer_enable)
|
||
|
continue;
|
||
|
|
||
|
if (cur_phy_num && cur_ext_num < ovl_ext_num[ovl_idx])
|
||
|
is_overlap = layer_is_overlap(cfg, i,
|
||
|
cur_phy_idx_in_cfg, i - 1);
|
||
|
else
|
||
|
is_overlap = 1;
|
||
|
|
||
|
if (!is_overlap) {
|
||
|
/* put it in ext layer */
|
||
|
cur_ext_num++;
|
||
|
continue;
|
||
|
}
|
||
|
|
||
|
/* now put it into a phy layer */
|
||
|
if (cur_phy_num < ovl_phy_num[ovl_idx]) {
|
||
|
cur_phy_num++;
|
||
|
cur_phy_idx_in_cfg = i;
|
||
|
} else if (ovl_idx < ARRAY_SIZE(ovl_phy_num)) {
|
||
|
/* dispatch to next ovl */
|
||
|
ovl_idx++;
|
||
|
cur_phy_num = 1;
|
||
|
cur_phy_idx_in_cfg = i;
|
||
|
cur_ext_num = 0;
|
||
|
} else {
|
||
|
/* no ovl layer aviable !! */
|
||
|
goto err_out;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
for (i = 0; i < ovl_idx; i++)
|
||
|
total_phy_layer += ovl_phy_num[i];
|
||
|
total_phy_layer += cur_phy_num;
|
||
|
return total_phy_layer;
|
||
|
|
||
|
err_out:
|
||
|
DISPWARN("%s failed: ovl_idx=%d, cur_phy=%d, cur_ext=%d\n",
|
||
|
__func__, ovl_idx, cur_phy_num, cur_ext_num);
|
||
|
for (i = 1; i < cfg->input_layer_num; i++)
|
||
|
dump_input_cfg_info(&cfg->input_cfg[i],
|
||
|
MAKE_DISP_SESSION(DISP_SESSION_PRIMARY, 0), 1);
|
||
|
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
int disp_layer_info_statistic(struct disp_ddp_path_config *last_config,
|
||
|
struct disp_frame_cfg_t *cfg)
|
||
|
{
|
||
|
unsigned int i, phy_num = 0, ext_num = 0;
|
||
|
int phy_num_with_arm_ext;
|
||
|
|
||
|
if (!READ_ONCE(layer_statistic_enable))
|
||
|
return 0;
|
||
|
|
||
|
layer_stat.total_frame_cnt++;
|
||
|
|
||
|
for (i = 0; i < cfg->input_layer_num; i++) {
|
||
|
if (!cfg->input_cfg[i].layer_enable)
|
||
|
continue;
|
||
|
if (cfg->input_cfg[i].ext_sel_layer != -1)
|
||
|
ext_num++;
|
||
|
else
|
||
|
phy_num++;
|
||
|
}
|
||
|
layer_stat.cnt_by_layers[phy_num + ext_num]++;
|
||
|
layer_stat.cnt_by_layers_with_ext[phy_num]++;
|
||
|
|
||
|
phy_num_with_arm_ext = calc_layer_num_with_arm_ext(cfg);
|
||
|
if (phy_num_with_arm_ext > 0) {
|
||
|
phy_num_with_arm_ext =
|
||
|
min(phy_num_with_arm_ext, STATISTIC_MAX_LAYERS);
|
||
|
layer_stat.cnt_by_layers_with_arm_ext[phy_num_with_arm_ext]++;
|
||
|
}
|
||
|
|
||
|
if (!(layer_stat.total_frame_cnt % 100)) {
|
||
|
char str[200];
|
||
|
int offset = 0;
|
||
|
|
||
|
offset += snprintf(str + offset, sizeof(str) - offset,
|
||
|
"total:%ld.layers:", layer_stat.total_frame_cnt);
|
||
|
for (i = 1; i <= 12; i++)
|
||
|
offset += snprintf(str + offset, sizeof(str) - offset,
|
||
|
"%ld,", layer_stat.cnt_by_layers[i]);
|
||
|
DISPMSG("layer_cnt %s\n", str);
|
||
|
|
||
|
offset = 0;
|
||
|
offset += snprintf(str + offset,
|
||
|
sizeof(str) - offset, ".ext:");
|
||
|
for (i = 1; i <= 6 ; i++)
|
||
|
offset += snprintf(str + offset, sizeof(str) - offset,
|
||
|
"%ld,", layer_stat.cnt_by_layers_with_ext[i]);
|
||
|
|
||
|
offset += snprintf(str + offset,
|
||
|
sizeof(str) - offset, ".arm_ext:");
|
||
|
for (i = 1; i <= 6 ; i++)
|
||
|
offset += snprintf(str + offset, sizeof(str) - offset,
|
||
|
"%ld,", layer_stat.cnt_by_layers_with_arm_ext[i]);
|
||
|
DISPMSG("layer_cnt %s\n", str);
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
void disp_layer_info_statistic_reset(void)
|
||
|
{
|
||
|
memset(&layer_stat, 0, sizeof(layer_stat));
|
||
|
}
|
||
|
|
||
|
/*********************** basic test ****************************/
|
||
|
static int basic_test_cancel;
|
||
|
static int draw_buffer(char *va, int w, int h,
|
||
|
enum UNIFIED_COLOR_FMT ufmt, char r, char g, char b, char a)
|
||
|
{
|
||
|
int i, j;
|
||
|
int Bpp = UFMT_GET_Bpp(ufmt);
|
||
|
|
||
|
for (i = 0; i < h; i++)
|
||
|
for (j = 0; j < w; j++) {
|
||
|
int x = j * Bpp + i * w * Bpp;
|
||
|
|
||
|
if (ufmt == UFMT_RGB888 || ufmt == UFMT_RGBA8888) {
|
||
|
va[x++] = r;
|
||
|
va[x++] = g;
|
||
|
va[x++] = b;
|
||
|
if (Bpp == 4)
|
||
|
va[x++] = a;
|
||
|
}
|
||
|
|
||
|
if (ufmt == UFMT_RGB565) {
|
||
|
va[x++] = (b & 0x1f) | ((g & 0x7) << 5);
|
||
|
va[x++] = (g & 0x7) | (r & 0x1f);
|
||
|
}
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
void save_bmp(const char *file_name, void *buf, int w, int h)
|
||
|
{
|
||
|
struct file *bmp;
|
||
|
mm_segment_t fs;
|
||
|
loff_t pos = 0;
|
||
|
int size = w * h * 3;
|
||
|
struct BMP_FILE_HEADER bfh;
|
||
|
struct BMP_INFO_HEADER bih;
|
||
|
|
||
|
bfh.bfType = 0x4d42;
|
||
|
bfh.bfSize = size + 14 + 40;
|
||
|
bfh.bfReserved1 = 0;
|
||
|
bfh.bfReserved2 = 0;
|
||
|
bfh.bfOffBits = 54;
|
||
|
|
||
|
bih.biSize = 40;
|
||
|
bih.biWidth = w;
|
||
|
bih.biHeight = h;
|
||
|
bih.biPlanes = 1;
|
||
|
bih.biBitCount = 24;
|
||
|
bih.biCompression = 0;
|
||
|
bih.biSizeImage = size;
|
||
|
bih.biXPelsPerMeter = 2835;
|
||
|
bih.biYPelsPerMeter = 2835;
|
||
|
bih.biClrUsed = 0;
|
||
|
bih.biClrImportant = 0;
|
||
|
|
||
|
bmp = filp_open(file_name, O_CREAT | O_RDWR, 0);
|
||
|
if (IS_ERR(bmp)) {
|
||
|
DISPERR("open output bmp file failed!\n");
|
||
|
return;
|
||
|
}
|
||
|
fs = get_fs();
|
||
|
set_fs(KERNEL_DS);
|
||
|
vfs_write(bmp, (const char *)&bfh.bfType,
|
||
|
sizeof(bfh.bfType), &pos);
|
||
|
vfs_write(bmp, (const char *)&bfh.bfSize,
|
||
|
sizeof(bfh.bfSize), &pos);
|
||
|
vfs_write(bmp, (const char *)&bfh.bfReserved1,
|
||
|
sizeof(bfh.bfReserved1), &pos);
|
||
|
vfs_write(bmp, (const char *)&bfh.bfReserved2,
|
||
|
sizeof(bfh.bfReserved2), &pos);
|
||
|
vfs_write(bmp, (const char *)&bfh.bfOffBits,
|
||
|
sizeof(bfh.bfOffBits), &pos);
|
||
|
vfs_write(bmp, (const char *)&bih.biSize,
|
||
|
sizeof(bih.biSize), &pos);
|
||
|
vfs_write(bmp, (const char *)&bih.biWidth,
|
||
|
sizeof(bih.biWidth), &pos);
|
||
|
vfs_write(bmp, (const char *)&bih.biHeight,
|
||
|
sizeof(bih.biHeight), &pos);
|
||
|
vfs_write(bmp, (const char *)&bih.biPlanes,
|
||
|
sizeof(bih.biPlanes), &pos);
|
||
|
vfs_write(bmp, (const char *)&bih.biBitCount,
|
||
|
sizeof(bih.biBitCount), &pos);
|
||
|
vfs_write(bmp, (const char *)&bih.biCompression,
|
||
|
sizeof(bih.biCompression), &pos);
|
||
|
vfs_write(bmp, (const char *)&bih.biSizeImage,
|
||
|
sizeof(bih.biSizeImage), &pos);
|
||
|
vfs_write(bmp, (const char *)&bih.biXPelsPerMeter,
|
||
|
sizeof(bih.biXPelsPerMeter), &pos);
|
||
|
vfs_write(bmp, (const char *)&bih.biYPelsPerMeter,
|
||
|
sizeof(bih.biYPelsPerMeter), &pos);
|
||
|
vfs_write(bmp, (const char *)&bih.biClrUsed,
|
||
|
sizeof(bih.biClrUsed), &pos);
|
||
|
vfs_write(bmp, (const char *)&bih.biClrImportant,
|
||
|
sizeof(bih.biClrImportant), &pos);
|
||
|
vfs_write(bmp, (const char *)buf, size, &pos);
|
||
|
filp_close(bmp, NULL);
|
||
|
set_fs(fs);
|
||
|
}
|
||
|
|
||
|
static void bmp_adjust(void *buf, int size, int w, int h)
|
||
|
{
|
||
|
int hpos, vpos;
|
||
|
void *temp;
|
||
|
UINT8 byte;
|
||
|
|
||
|
size = w * 3;
|
||
|
temp = vmalloc(size);
|
||
|
if (!temp)
|
||
|
return;
|
||
|
|
||
|
for (vpos = 0; vpos < h/2; vpos++) {
|
||
|
memcpy(temp, buf + (h-vpos - 1) * size, size);
|
||
|
memcpy(buf + (h-vpos - 1) * size, buf +
|
||
|
vpos * size, size);
|
||
|
memcpy(buf + vpos * size, temp, size);
|
||
|
}
|
||
|
for (vpos = 0; vpos < h; vpos++) {
|
||
|
for (hpos = 0; hpos < w; hpos++) {
|
||
|
byte = *(UINT8 *)(buf + (vpos * size) + hpos * 3);
|
||
|
*(UINT8 *)(buf + (vpos * size) + hpos * 3) =
|
||
|
*(UINT8 *)(buf + (vpos * size) + hpos * 3 + 2);
|
||
|
*(UINT8 *)(buf + (vpos * size) + hpos * 3 + 2) = byte;
|
||
|
}
|
||
|
}
|
||
|
vfree(temp);
|
||
|
}
|
||
|
|
||
|
struct test_buf_info {
|
||
|
struct ion_client *ion_client;
|
||
|
#ifdef CONFIG_MTK_M4U
|
||
|
struct m4u_client_t *m4u_client;
|
||
|
#endif
|
||
|
struct ion_handle *handle;
|
||
|
size_t size;
|
||
|
void *buf_va;
|
||
|
dma_addr_t buf_pa;
|
||
|
unsigned long buf_mva;
|
||
|
};
|
||
|
|
||
|
static int alloc_buffer_from_ion(size_t size, struct test_buf_info *buf_info)
|
||
|
{
|
||
|
#if defined(MTK_FB_ION_SUPPORT)
|
||
|
struct ion_client *client;
|
||
|
struct ion_mm_data mm_data;
|
||
|
struct ion_handle *handle;
|
||
|
size_t mva_size;
|
||
|
ion_phys_addr_t phy_addr = 0;
|
||
|
|
||
|
client = ion_client_create(g_ion_device, "disp_test");
|
||
|
buf_info->ion_client = client;
|
||
|
|
||
|
memset((void *)&mm_data, 0, sizeof(struct ion_mm_data));
|
||
|
|
||
|
handle = ion_alloc(client, size, 0, ION_HEAP_MULTIMEDIA_MASK, 0);
|
||
|
if (IS_ERR(buf_info->handle)) {
|
||
|
DISPWARN("Fatal Error, ion_alloc for size %zu failed\n", size);
|
||
|
ion_client_destroy(client);
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
buf_info->buf_va = ion_map_kernel(client, handle);
|
||
|
if (buf_info->buf_va == NULL) {
|
||
|
DISPWARN("ion_map_kernrl failed\n");
|
||
|
ion_free(client, handle);
|
||
|
ion_client_destroy(client);
|
||
|
return -1;
|
||
|
}
|
||
|
mm_data.config_buffer_param.kernel_handle = handle;
|
||
|
mm_data.mm_cmd = ION_MM_CONFIG_BUFFER;
|
||
|
if (ion_kernel_ioctl(client, ION_CMD_MULTIMEDIA,
|
||
|
(unsigned long)&mm_data) < 0) {
|
||
|
DISPWARN("ion_test_drv: Config buffer failed.\n");
|
||
|
ion_free(client, handle);
|
||
|
ion_client_destroy(client);
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
ion_phys(client, handle, &phy_addr, (size_t *)&mva_size);
|
||
|
buf_info->buf_mva = (unsigned int)phy_addr;
|
||
|
if (buf_info->buf_mva == 0) {
|
||
|
DISPWARN("Fatal Error, get mva failed\n");
|
||
|
ion_free(client, handle);
|
||
|
ion_client_destroy(client);
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
buf_info->handle = handle;
|
||
|
#endif
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int alloc_buffer_from_dma(size_t size, struct test_buf_info *buf_info)
|
||
|
{
|
||
|
int ret = 0;
|
||
|
unsigned long size_align;
|
||
|
|
||
|
unsigned int mva = 0;
|
||
|
|
||
|
size_align = round_up(size, PAGE_SIZE);
|
||
|
|
||
|
arch_setup_dma_ops(disp_get_device(), 0, 0, NULL, false);
|
||
|
|
||
|
buf_info->buf_va = dma_alloc_coherent(disp_get_device(),
|
||
|
size, &buf_info->buf_pa, GFP_KERNEL);
|
||
|
if (!(buf_info->buf_va)) {
|
||
|
DISPMSG(
|
||
|
"dma_alloc_coherent error! dma memory not available. size=%zu\n",
|
||
|
size);
|
||
|
return -1;
|
||
|
}
|
||
|
buf_info->size = size;
|
||
|
|
||
|
if (disp_helper_get_option(DISP_OPT_USE_M4U)) {
|
||
|
static struct sg_table table;
|
||
|
struct sg_table *sg_table = &table;
|
||
|
|
||
|
ret = sg_alloc_table(sg_table, 1, GFP_KERNEL);
|
||
|
if (ret) {
|
||
|
DISPWARN("sg alloc table failed!\n");
|
||
|
goto out1;
|
||
|
}
|
||
|
|
||
|
sg_dma_address(sg_table->sgl) = buf_info->buf_pa;
|
||
|
sg_dma_len(sg_table->sgl) = size_align;
|
||
|
buf_info->m4u_client = m4u_create_client();
|
||
|
if (IS_ERR_OR_NULL(buf_info->m4u_client))
|
||
|
DISPWARN("create client fail!\n");
|
||
|
|
||
|
ret = m4u_alloc_mva(buf_info->m4u_client,
|
||
|
DISP_M4U_PORT_DISP_OVL0, 0, sg_table, size_align,
|
||
|
M4U_PROT_READ | M4U_PROT_WRITE, 0, &mva);
|
||
|
if (ret)
|
||
|
DISPWARN("m4u_alloc_mva returns fail: %d\n", ret);
|
||
|
}
|
||
|
out1:
|
||
|
buf_info->buf_mva = mva;
|
||
|
DISPMSG("%s MVA is 0x%x PA is 0x%pa\n",
|
||
|
__func__, mva, &buf_info->buf_pa);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static int release_test_buf(struct test_buf_info *buf_info)
|
||
|
{
|
||
|
#if defined(MTK_FB_ION_SUPPORT)
|
||
|
if (disp_helper_get_option(DISP_OPT_USE_M4U)) {
|
||
|
/* ion buffer */
|
||
|
if (buf_info->handle)
|
||
|
ion_free(buf_info->ion_client, buf_info->handle);
|
||
|
else
|
||
|
dma_free_coherent(disp_get_device(), buf_info->size,
|
||
|
buf_info->buf_va, buf_info->buf_pa);
|
||
|
|
||
|
#ifdef CONFIG_MTK_M4U
|
||
|
if (buf_info->m4u_client)
|
||
|
m4u_destroy_client(buf_info->m4u_client);
|
||
|
#endif
|
||
|
if (buf_info->ion_client)
|
||
|
ion_client_destroy(buf_info->ion_client);
|
||
|
}
|
||
|
if (!disp_helper_get_option(DISP_OPT_USE_M4U))
|
||
|
dma_free_coherent(disp_get_device(), buf_info->size,
|
||
|
buf_info->buf_va, buf_info->buf_pa);
|
||
|
#endif
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int test_alloc_buffer(size_t size, struct test_buf_info *buf_info)
|
||
|
{
|
||
|
int ret;
|
||
|
|
||
|
if (disp_helper_get_option(DISP_OPT_USE_M4U))
|
||
|
ret = alloc_buffer_from_ion(size, buf_info);
|
||
|
else
|
||
|
ret = alloc_buffer_from_dma(size, buf_info);
|
||
|
|
||
|
if (ret)
|
||
|
DISPWARN("error to alloc buffer size = %lu\n",
|
||
|
(unsigned long)size);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
/* don't compare if cksum_golden == 0 */
|
||
|
static unsigned int cksum_golden;
|
||
|
static cmdqBackupSlotHandle cksum_slot;
|
||
|
|
||
|
static int __maybe_unused compare_dsi_checksum(unsigned long unused)
|
||
|
{
|
||
|
unsigned int cksum;
|
||
|
int ret;
|
||
|
|
||
|
if (!cksum_golden)
|
||
|
return 0;
|
||
|
|
||
|
ret = cmdqBackupReadSlot(cksum_slot, 0, &cksum);
|
||
|
if (ret) {
|
||
|
DISPWARN("Fail to read cksum from cmdq slot\n");
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
if (cksum_golden != cksum)
|
||
|
DISPWARN("%s fail, cksum=0x%08x, golden=0x%08x\n",
|
||
|
__func__, cksum, cksum_golden);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int __maybe_unused check_dsi_checksum(void)
|
||
|
{
|
||
|
struct cmdqRecStruct *handle;
|
||
|
int ret;
|
||
|
|
||
|
if (!cksum_golden)
|
||
|
return 0;
|
||
|
|
||
|
ret = cmdqRecCreate(CMDQ_SCENARIO_PRIMARY_DISP, &handle);
|
||
|
if (ret) {
|
||
|
DISPWARN("Fail to create cmdq handle\n");
|
||
|
return -1;
|
||
|
}
|
||
|
if (!cksum_slot) {
|
||
|
ret = cmdqBackupAllocateSlot(&cksum_slot, 1);
|
||
|
if (ret) {
|
||
|
DISPWARN("Fail to alloc cmd slot\n");
|
||
|
cmdqRecDestroy(handle);
|
||
|
return -1;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
cmdqRecReset(handle);
|
||
|
_cmdq_insert_wait_frame_done_token_mira(handle);
|
||
|
cmdqRecBackupRegisterToSlot(handle, cksum_slot, 0,
|
||
|
disp_addr_convert(DISPSYS_DSI0_BASE + 0x144));
|
||
|
cmdqRecFlushAsyncCallback(handle, compare_dsi_checksum, 0);
|
||
|
cmdqRecDestroy(handle);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/* mutex to prevent test being called in different adb shell process */
|
||
|
DEFINE_MUTEX(basic_test_lock);
|
||
|
|
||
|
static int primary_display_basic_test(int layer_num, unsigned int layer_en_mask,
|
||
|
int w, int h, enum DISP_FORMAT fmt, int frame_num,
|
||
|
int vsync_num, int offset_x, int offset_y,
|
||
|
unsigned int r, unsigned int g, unsigned int b, unsigned int a,
|
||
|
int mode, unsigned int cksum)
|
||
|
{
|
||
|
int session_id = MAKE_DISP_SESSION(DISP_SESSION_PRIMARY, 0);
|
||
|
unsigned int Bpp, frame, i;
|
||
|
enum UNIFIED_COLOR_FMT ufmt;
|
||
|
struct disp_frame_cfg_t *cfg;
|
||
|
int lcm_width = primary_display_get_width();
|
||
|
int lcm_height = primary_display_get_height();
|
||
|
enum DISP_FORMAT out_fmt = DISP_FORMAT_RGB888;
|
||
|
size_t size, test_size;
|
||
|
struct test_buf_info buf_info[PRIMARY_SESSION_INPUT_LAYER_COUNT];
|
||
|
struct test_buf_info output_buf_info;
|
||
|
|
||
|
cksum_golden = cksum;
|
||
|
ufmt = disp_fmt_to_unified_fmt(fmt);
|
||
|
Bpp = UFMT_GET_bpp(ufmt) / 8;
|
||
|
size = w * h * Bpp;
|
||
|
mutex_lock(&basic_test_lock);
|
||
|
|
||
|
DISPMSG(
|
||
|
"%s:layer_num=%u,en=0x%x,w=%d,h=%d,fmt=%s,frame_num=%d,vsync=%d,size=%lu\n",
|
||
|
__func__, layer_num, layer_en_mask,
|
||
|
w, h, unified_color_fmt_name(ufmt), frame_num,
|
||
|
vsync_num, (unsigned long)size);
|
||
|
|
||
|
if (layer_num > PRIMARY_SESSION_INPUT_LAYER_COUNT)
|
||
|
goto out_unlock;
|
||
|
|
||
|
cfg = kmalloc(sizeof(*cfg), GFP_KERNEL);
|
||
|
if (!cfg)
|
||
|
goto out_unlock;
|
||
|
|
||
|
/* ======prepare buffer========= */
|
||
|
/* Input buffer */
|
||
|
for (i = 0; i < PRIMARY_SESSION_INPUT_LAYER_COUNT; i++) {
|
||
|
memset(&buf_info[i], 0, sizeof(buf_info[i]));
|
||
|
test_alloc_buffer(size, &buf_info[i]);
|
||
|
draw_buffer(buf_info[i].buf_va, w, h, ufmt, r, g, b, a);
|
||
|
}
|
||
|
|
||
|
/* Output buffer */
|
||
|
if ((mode == DISP_SESSION_DIRECT_LINK_MIRROR_MODE ||
|
||
|
mode == DISP_SESSION_DECOUPLE_MIRROR_MODE)) {
|
||
|
memset(&output_buf_info, 0, sizeof(output_buf_info));
|
||
|
test_size = lcm_width * lcm_height *
|
||
|
UFMT_GET_Bpp(disp_fmt_to_unified_fmt(out_fmt));
|
||
|
test_alloc_buffer(test_size, &output_buf_info);
|
||
|
}
|
||
|
/* ======prepare config info========= */
|
||
|
memset(cfg, 0, sizeof(*cfg));
|
||
|
cfg->session_id = session_id;
|
||
|
cfg->setter = SESSION_USER_HWC;
|
||
|
cfg->input_layer_num = layer_num;
|
||
|
cfg->overlap_layer_num = 4;
|
||
|
cfg->present_fence_idx = -1;
|
||
|
for (i = 0; i < layer_num; i++) {
|
||
|
cfg->input_cfg[i].layer_id = i;
|
||
|
cfg->input_cfg[i].layer_enable = !!(layer_en_mask & (1 << i));
|
||
|
cfg->input_cfg[i].src_base_addr = 0;
|
||
|
if (disp_helper_get_option(DISP_OPT_USE_M4U))
|
||
|
cfg->input_cfg[i].src_phy_addr =
|
||
|
(void *)((unsigned long)buf_info[i].buf_mva);
|
||
|
else
|
||
|
cfg->input_cfg[i].src_phy_addr =
|
||
|
(void *)((unsigned long)buf_info[i].buf_pa);
|
||
|
cfg->input_cfg[i].next_buff_idx = -1;
|
||
|
cfg->input_cfg[i].src_fmt = fmt;
|
||
|
cfg->input_cfg[i].src_pitch = w;
|
||
|
cfg->input_cfg[i].src_offset_x = 0;
|
||
|
cfg->input_cfg[i].src_offset_y = 0;
|
||
|
cfg->input_cfg[i].src_width = w;
|
||
|
cfg->input_cfg[i].src_height = h;
|
||
|
|
||
|
cfg->input_cfg[i].tgt_offset_x = i * offset_x;
|
||
|
cfg->input_cfg[i].tgt_offset_y = i * offset_y;
|
||
|
cfg->input_cfg[i].tgt_width = w;
|
||
|
cfg->input_cfg[i].tgt_height = h;
|
||
|
cfg->input_cfg[i].alpha_enable = 1;
|
||
|
cfg->input_cfg[i].alpha = 0xff;
|
||
|
cfg->input_cfg[i].security = DISP_NORMAL_BUFFER;
|
||
|
cfg->input_cfg[i].ext_sel_layer = -1;
|
||
|
}
|
||
|
if ((mode == DISP_SESSION_DIRECT_LINK_MIRROR_MODE ||
|
||
|
mode == DISP_SESSION_DECOUPLE_MIRROR_MODE)) {
|
||
|
cfg->output_en = 1;
|
||
|
if (disp_helper_get_option(DISP_OPT_USE_M4U))
|
||
|
cfg->output_cfg.pa =
|
||
|
(void *)(output_buf_info.buf_mva);
|
||
|
else
|
||
|
cfg->output_cfg.pa =
|
||
|
(void *)((unsigned long)output_buf_info.buf_pa);
|
||
|
cfg->output_cfg.fmt = out_fmt;
|
||
|
cfg->output_cfg.width = lcm_width;
|
||
|
cfg->output_cfg.height = lcm_height;
|
||
|
cfg->output_cfg.pitch = lcm_width;
|
||
|
cfg->output_cfg.security = DISP_NORMAL_BUFFER;
|
||
|
cfg->output_cfg.buff_idx = -1;
|
||
|
cfg->output_cfg.interface_idx = -1;
|
||
|
}
|
||
|
|
||
|
/*========start to trigger path =============*/
|
||
|
DSI_enable_checksum(DISP_MODULE_DSI0, NULL);
|
||
|
for (frame = 0; frame < frame_num; frame++) {
|
||
|
primary_display_switch_mode(mode, session_id, 1);
|
||
|
primary_display_frame_cfg(cfg);
|
||
|
for (i = 0; i < vsync_num; i++) {
|
||
|
struct disp_session_vsync_config vsync_config;
|
||
|
|
||
|
vsync_config.session_id = session_id;
|
||
|
primary_display_wait_for_vsync(&vsync_config);
|
||
|
}
|
||
|
check_dsi_checksum();
|
||
|
|
||
|
if (unlikely(basic_test_cancel)) {
|
||
|
DISPWARN("%s stop because fatal signal\n", __func__);
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* disable all layers */
|
||
|
for (i = 0; i < layer_num; i++) {
|
||
|
cfg->input_cfg[i].layer_id = i;
|
||
|
cfg->input_cfg[i].layer_enable = 0;
|
||
|
}
|
||
|
primary_display_switch_mode(DISP_SESSION_DIRECT_LINK_MODE,
|
||
|
session_id, 1);
|
||
|
primary_display_frame_cfg(cfg);
|
||
|
msleep(100);
|
||
|
|
||
|
for (i = 0; i < PRIMARY_SESSION_INPUT_LAYER_COUNT; i++)
|
||
|
release_test_buf(&buf_info[i]);
|
||
|
if ((mode == DISP_SESSION_DIRECT_LINK_MIRROR_MODE ||
|
||
|
mode == DISP_SESSION_DECOUPLE_MIRROR_MODE))
|
||
|
release_test_buf(&output_buf_info);
|
||
|
kfree(cfg);
|
||
|
|
||
|
out_unlock:
|
||
|
mutex_unlock(&basic_test_lock);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* provided by @CJ
|
||
|
* disp_fake_engine_config (rd_addr, wr_add, 1, 2047, 3, 0, 0, 0, 1, 0)
|
||
|
* wr_pat: 1
|
||
|
* length: 2047
|
||
|
* burst : 3
|
||
|
* disable_rd : 0
|
||
|
* disable_wr : 0
|
||
|
* latency : 0
|
||
|
* loop : 1
|
||
|
*/
|
||
|
static int disp_fake_engine_config(
|
||
|
unsigned int rd_add,
|
||
|
unsigned int wr_add,
|
||
|
unsigned int wr_pat,
|
||
|
unsigned int length,
|
||
|
unsigned int brust,
|
||
|
unsigned int disable_rd,
|
||
|
unsigned int disable_wr,
|
||
|
unsigned int latency,
|
||
|
unsigned int loop)
|
||
|
{
|
||
|
primary_display_idlemgr_kick(__func__, 1);
|
||
|
DISP_REG_SET_FIELD(NULL, MMSYS_CG_FLD_FAKE_ENG,
|
||
|
DISP_REG_CONFIG_MMSYS_CG_CLR0, 0x01);
|
||
|
DISP_REG_SET(NULL, DISP_REG_CONFIG_DISP_FAKE_ENG_RD_ADDR,
|
||
|
rd_add);
|
||
|
DISP_REG_SET(NULL, DISP_REG_CONFIG_DISP_FAKE_ENG_WR_ADDR,
|
||
|
wr_add);
|
||
|
DISP_REG_SET(NULL, DISP_REG_CONFIG_DISP_FAKE_ENG_CON0,
|
||
|
(wr_pat<<24) | (loop<<22) | (length));
|
||
|
DISP_REG_SET(NULL, DISP_REG_CONFIG_DISP_FAKE_ENG_CON1,
|
||
|
(brust<<12) | (disable_wr<<11) |
|
||
|
(disable_rd<<10) | (latency));
|
||
|
DISP_REG_SET(NULL, DISP_REG_CONFIG_DISP_FAKE_ENG_EN, 3);
|
||
|
DISPMSG("Fake eng start dump CG_CON0 = 0x%x\n",
|
||
|
DISP_REG_GET(DISP_REG_CONFIG_MMSYS_CG_CON0));
|
||
|
DISPMSG("Fake eng start dump RD_ADDR = 0x%x\n",
|
||
|
DISP_REG_GET(DISP_REG_CONFIG_DISP_FAKE_ENG_RD_ADDR));
|
||
|
DISPMSG("Fake eng start dump WD_ADDR = 0x%x\n",
|
||
|
DISP_REG_GET(DISP_REG_CONFIG_DISP_FAKE_ENG_WR_ADDR));
|
||
|
DISPMSG("Fake eng start dump FAKE_CON0 = 0x%x\n",
|
||
|
DISP_REG_GET(DISP_REG_CONFIG_DISP_FAKE_ENG_CON0));
|
||
|
DISPMSG("Fake eng start dump FAKE_CON1 = 0x%x\n",
|
||
|
DISP_REG_GET(DISP_REG_CONFIG_DISP_FAKE_ENG_CON1));
|
||
|
DISPMSG("Fake eng start dump FAKE_EN = 0x%x\n",
|
||
|
DISP_REG_GET(DISP_REG_CONFIG_DISP_FAKE_ENG_EN));
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int disp_fake_engine_stop(void)
|
||
|
{
|
||
|
DISP_REG_SET(NULL, DISP_REG_CONFIG_DISP_FAKE_ENG_EN, 1);
|
||
|
|
||
|
DISP_REG_SET(NULL, DISP_REG_CONFIG_DISP_FAKE_ENG_RST, 1);
|
||
|
DISP_REG_SET(NULL, DISP_REG_CONFIG_DISP_FAKE_ENG_RST, 0);
|
||
|
DISP_REG_SET_FIELD(NULL, MMSYS_CG_FLD_FAKE_ENG,
|
||
|
DISP_REG_CONFIG_MMSYS_CG_SET0, 0x01);
|
||
|
DISPMSG("Fake eng end dump CG_CON0 = 0x%x\n",
|
||
|
DISP_REG_GET(DISP_REG_CONFIG_MMSYS_CG_CON0));
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static void do_helper_opt(const char *opt)
|
||
|
{
|
||
|
int ret = 0;
|
||
|
char option[100] = "";
|
||
|
char *tmp;
|
||
|
int value, i;
|
||
|
|
||
|
/*ex: echo helper:DISP_OPT_BYPASS_OVL,0 > /d/mtkfb */
|
||
|
tmp = (char *)(opt + 7);
|
||
|
for (i = 0; i < 50; i++) {
|
||
|
if (tmp[i] != ',' && tmp[i] != ' ')
|
||
|
option[i] = tmp[i];
|
||
|
else
|
||
|
break;
|
||
|
}
|
||
|
tmp += i + 1;
|
||
|
ret = sscanf(tmp, "%d\n", &value);
|
||
|
if (ret != 1) {
|
||
|
DISPWARN("error to parse cmd %s: %s %s ret=%d\n",
|
||
|
opt, option, tmp, ret);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
DISPMSG("will set option %s to %d\n", option, value);
|
||
|
disp_helper_set_option_by_name(option, value);
|
||
|
|
||
|
}
|
||
|
|
||
|
static void do_set_emi_bound_tb_opt(const char *opt)
|
||
|
{
|
||
|
int ret = 0;
|
||
|
int num, i, idx;
|
||
|
int val[8] = {0};
|
||
|
char *fmt;
|
||
|
int size = sizeof("set_emi_bound_tb:%d") +
|
||
|
strlen(",%d") * ARRAY_SIZE(val);
|
||
|
|
||
|
fmt = kzalloc(size, GFP_KERNEL);
|
||
|
if (!fmt)
|
||
|
return;
|
||
|
|
||
|
strncpy(fmt, "set_emi_bound_tb:%d", size);
|
||
|
fmt[size - 1] = '\0';
|
||
|
|
||
|
for (i = 0; i < ARRAY_SIZE(val); i++) {
|
||
|
/* make fmt like: "set_dsi_cmd:%d,%d,%d\n" */
|
||
|
strncat(fmt, ",%d", size - strlen(fmt) - 1);
|
||
|
}
|
||
|
strncat(fmt, "\n", size - strlen(fmt) - 1);
|
||
|
|
||
|
num = sscanf(opt, fmt, &idx, &val[0], &val[1], &val[2],
|
||
|
&val[3], &val[4], &val[5], &val[6], &val[7]);
|
||
|
|
||
|
if (num < 2 || num > HRT_LEVEL_NUM + 1)
|
||
|
goto done;
|
||
|
|
||
|
ret = set_emi_bound_tb(idx, num - 1, val);
|
||
|
|
||
|
done:
|
||
|
kfree(fmt);
|
||
|
fmt = NULL;
|
||
|
}
|
||
|
|
||
|
struct completion dump_buf_comp;
|
||
|
|
||
|
static void process_dbg_opt(const char *opt)
|
||
|
{
|
||
|
int ret;
|
||
|
|
||
|
DISPMSG("disp debug cmd %s\n", opt);
|
||
|
|
||
|
if (strncmp(opt, "helper", 6) == 0) {
|
||
|
/*ex: echo helper:DISP_OPT_BYPASS_OVL,0 > /d/mtkfb */
|
||
|
do_helper_opt(opt);
|
||
|
#ifdef CONFIG_MTK_MT6382_BDG
|
||
|
} else if (strncmp(opt, "mipi_hopping:on", 15) == 0) {
|
||
|
if (pgc->state == DISP_SLEPT) {
|
||
|
DISPWARN("primary display is already slept\n");
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
if (pgc->pm == FB_SUSPEND || _is_power_on_status(DISP_MODULE_DSI0) == 0) {
|
||
|
DISPWARN("Power mode is FB_SUSPEND[pgc->pm:%d] or DSI power off[%d]:\n",
|
||
|
pgc->pm, _is_power_on_status(DISP_MODULE_DSI0));
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
primary_display_idlemgr_kick(__func__, 1);
|
||
|
if (dpmgr_path_is_busy(pgc->dpmgr_handle))
|
||
|
dpmgr_wait_event_timeout(pgc->dpmgr_handle,
|
||
|
DISP_PATH_EVENT_FRAME_DONE, HZ * 1);
|
||
|
DSI_Stop(DISP_MODULE_DSI0, NULL);
|
||
|
|
||
|
bdg_mipi_clk_change(1, 1);
|
||
|
|
||
|
DSI_Start(DISP_MODULE_DSI0, NULL);
|
||
|
} else if (strncmp(opt, "mipi_hopping:off", 16) == 0) {
|
||
|
if (pgc->state == DISP_SLEPT) {
|
||
|
DISPWARN("primary display is already slept\n");
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
if (pgc->pm == FB_SUSPEND || _is_power_on_status(DISP_MODULE_DSI0) == 0) {
|
||
|
DISPWARN("Power mode is FB_SUSPEND[pgc->pm:%d] or DSI power off[%d]:\n",
|
||
|
pgc->pm, _is_power_on_status(DISP_MODULE_DSI0));
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
primary_display_idlemgr_kick(__func__, 1);
|
||
|
if (dpmgr_path_is_busy(pgc->dpmgr_handle))
|
||
|
dpmgr_wait_event_timeout(pgc->dpmgr_handle,
|
||
|
DISP_PATH_EVENT_FRAME_DONE, HZ * 1);
|
||
|
DSI_Stop(DISP_MODULE_DSI0, NULL);
|
||
|
|
||
|
bdg_mipi_clk_change(1, 0);
|
||
|
|
||
|
DSI_Start(DISP_MODULE_DSI0, NULL);
|
||
|
#endif
|
||
|
} else if (strncmp(opt, "switch_mode:", 12) == 0) {
|
||
|
int session_id = MAKE_DISP_SESSION(DISP_SESSION_PRIMARY, 0);
|
||
|
int sess_mode;
|
||
|
|
||
|
ret = sscanf(opt, "switch_mode:%d\n", &sess_mode);
|
||
|
if (ret != 1) {
|
||
|
DISPWARN("%d error to parse cmd %s\n", __LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
primary_display_switch_mode(sess_mode, session_id, 1);
|
||
|
} else if (strncmp(opt, "hrt_debug", 9) == 0) {
|
||
|
gen_hrt_pattern();
|
||
|
DISPMSG("hrt_debug\n");
|
||
|
} else if (strncmp(opt, "dsi_mode:cmd", 12) == 0) {
|
||
|
lcm_mode_status = 1;
|
||
|
DISPMSG("switch cmd\n");
|
||
|
} else if (strncmp(opt, "dsi_mode:vdo", 12) == 0) {
|
||
|
DISPMSG("switch vdo\n");
|
||
|
lcm_mode_status = 2;
|
||
|
} else if (strncmp(opt, "clk_change:", 11) == 0) {
|
||
|
char *p = (char *)opt + 11;
|
||
|
unsigned int clk = 0;
|
||
|
|
||
|
ret = kstrtouint(p, 0, &clk);
|
||
|
if (ret) {
|
||
|
DISPWARN("%d error to parse cmd %s\n", __LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
DISPCHECK("clk_change:%d\n", clk);
|
||
|
primary_display_mipi_clk_change(clk);
|
||
|
} else if (strncmp(opt, "dsipattern:", 11) == 0) {
|
||
|
char *p = (char *)opt + 11;
|
||
|
unsigned int pattern;
|
||
|
|
||
|
ret = kstrtouint(p, 0, &pattern);
|
||
|
if (ret) {
|
||
|
DISPWARN("%d error to parse cmd %s\n", __LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
if (pattern) {
|
||
|
DSI_BIST_Pattern_Test(DISP_MODULE_DSI0, NULL,
|
||
|
true, pattern);
|
||
|
DISPMSG("enable dsi pattern: 0x%08x\n", pattern);
|
||
|
} else {
|
||
|
primary_display_manual_lock();
|
||
|
DSI_BIST_Pattern_Test(DISP_MODULE_DSI0, NULL, false, 0);
|
||
|
primary_display_manual_unlock();
|
||
|
return;
|
||
|
}
|
||
|
#ifdef CONFIG_MTK_MT6382_BDG
|
||
|
} else if (strncmp(opt, "set_data_rate:", 14) == 0) {
|
||
|
unsigned int data_rate = 0;
|
||
|
int ret = -1;
|
||
|
|
||
|
ret = sscanf(opt, "set_data_rate:%d\n",
|
||
|
&data_rate);
|
||
|
if (ret != 1) {
|
||
|
DISPERR("%d error to parse set_data_rate cmd %s\n",
|
||
|
__LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
set_bdg_data_rate(data_rate);
|
||
|
|
||
|
} else if (strncmp(opt, "6382_rst_test_0:", 16) == 0) {
|
||
|
bdg_tx_set_6382_reset_pin(0);
|
||
|
} else if (strncmp(opt, "6382_rst_test_1:", 16) == 0) {
|
||
|
bdg_tx_set_6382_reset_pin(1);
|
||
|
} else if (strncmp(opt, "dsi_enable:", 11) == 0) {
|
||
|
struct LCM_PARAMS *lcm_param = NULL;
|
||
|
struct disp_ddp_path_config *data_config;
|
||
|
unsigned int dsi_on = 0;
|
||
|
int ret = -1;
|
||
|
|
||
|
ret = sscanf(opt, "dsi_enable:%d\n",
|
||
|
&dsi_on);
|
||
|
if (ret != 1) {
|
||
|
DISPERR("%d error to parse dsi_enable cmd %s\n",
|
||
|
__LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
lcm_param = disp_lcm_get_params(pgc->plcm);
|
||
|
|
||
|
if (!lcm_param) {
|
||
|
DISPMSG("lcm_param is null\n");
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
data_config = dpmgr_path_get_last_config(pgc->dpmgr_handle);
|
||
|
memcpy(&(data_config->dispif_config), lcm_param,
|
||
|
sizeof(struct LCM_PARAMS));
|
||
|
|
||
|
if (dsi_on) {
|
||
|
bdg_tx_init(DISP_BDG_DSI0, data_config, NULL);
|
||
|
bdg_tx_bist_pattern(DISP_BDG_DSI0, NULL, TRUE, 0, 0x3ff, 0, 0);
|
||
|
bdg_tx_start(DISP_BDG_DSI0, NULL);
|
||
|
} else {
|
||
|
bdg_tx_stop(DISP_BDG_DSI0, NULL);
|
||
|
bdg_tx_wait_for_idle(DISP_BDG_DSI0);
|
||
|
bdg_tx_bist_pattern(DISP_BDG_DSI0, NULL, FALSE, 0, 0, 0, 0);
|
||
|
bdg_tx_deinit(DISP_BDG_DSI0, NULL);
|
||
|
}
|
||
|
|
||
|
} else if (strncmp(opt, "dump", 4) == 0) {
|
||
|
|
||
|
DSI_DumpRegisters(DISP_MODULE_DSI0, 1);
|
||
|
|
||
|
} else if (strncmp(opt, "xdump", 5) == 0) {
|
||
|
|
||
|
bdg_dsi_dump_reg(DISP_BDG_DSI0, 1);
|
||
|
|
||
|
} else if (strncmp(opt, "bdg_int", 7) == 0) {
|
||
|
struct LCM_PARAMS *lcm_param = NULL;
|
||
|
struct disp_ddp_path_config *data_config;
|
||
|
|
||
|
lcm_param = disp_lcm_get_params(pgc->plcm);
|
||
|
|
||
|
if (!lcm_param)
|
||
|
DISPMSG("lcm_param is null\n");
|
||
|
|
||
|
data_config = dpmgr_path_get_last_config(pgc->dpmgr_handle);
|
||
|
memcpy(&(data_config->dispif_config), lcm_param,
|
||
|
sizeof(struct LCM_PARAMS));
|
||
|
|
||
|
bdg_common_init(DISP_BDG_DSI0, data_config, NULL);
|
||
|
mipi_dsi_rx_mac_init(DISP_BDG_DSI0, data_config, NULL);
|
||
|
} else if (strncmp(opt, "xbdg_int", 8) == 0) {
|
||
|
struct LCM_PARAMS *lcm_param = NULL;
|
||
|
struct disp_ddp_path_config *data_config;
|
||
|
|
||
|
lcm_param = disp_lcm_get_params(pgc->plcm);
|
||
|
|
||
|
if (!lcm_param)
|
||
|
DISPMSG("lcm_param is null\n");
|
||
|
|
||
|
data_config = dpmgr_path_get_last_config(pgc->dpmgr_handle);
|
||
|
memcpy(&(data_config->dispif_config), lcm_param,
|
||
|
sizeof(struct LCM_PARAMS));
|
||
|
|
||
|
bdg_common_init_for_rx_pat(DISP_BDG_DSI0, data_config, NULL);
|
||
|
|
||
|
} else if (!strncmp(opt, "set_mask_spi:", 13)) {
|
||
|
unsigned int addr = 0, val = 0, mask = 0;
|
||
|
int ret = -1;
|
||
|
|
||
|
ret = sscanf(opt, "set_mask_spi:addr=0x%x,mask=0x%x,val=0x%x\n",
|
||
|
&addr, &mask, &val);
|
||
|
if (ret != 3) {
|
||
|
DISPERR("%d error to parse set_mt6382_spi cmd %s\n",
|
||
|
__LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
ret = mtk_spi_mask_write(addr, mask, val);
|
||
|
if (ret < 0) {
|
||
|
DISPERR("write mt6382 fail,addr:0x%x, val:0x%x\n",
|
||
|
addr, val);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
} else if (!strncmp(opt, "set_mt6382_spi:", 15)) {
|
||
|
unsigned int addr = 0, val = 0;
|
||
|
int ret = -1;
|
||
|
|
||
|
ret = sscanf(opt, "set_mt6382_spi:addr=0x%x,val=0x%x\n",
|
||
|
&addr, &val);
|
||
|
if (ret != 2) {
|
||
|
DISPERR("%d error to parse set_mt6382_spi cmd %s\n",
|
||
|
__LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
ret = mtk_spi_write(addr, val);
|
||
|
// ret = dsp_spi_write_ex(addr, &val, 4, speed);
|
||
|
if (ret < 0) {
|
||
|
DISPERR("write mt6382 fail,addr:0x%x, val:0x%x\n",
|
||
|
addr, val);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
} else if (!strncmp(opt, "read_mt6382_spi:", 16)) {
|
||
|
unsigned int addr = 0, val = 0;
|
||
|
|
||
|
ret = sscanf(opt, "read_mt6382_spi:addr=0x%x\n", &addr);
|
||
|
if (ret != 1) {
|
||
|
DISPERR("%d error to parse read_mt6382_spi cmd %s\n",
|
||
|
__LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
val = mtk_spi_read(addr);
|
||
|
// ret = dsp_spi_read_ex(addr, &val, 4, speed);
|
||
|
// if (ret < 0) {
|
||
|
// DISPERR("read mt6382 fail,addr:0x%x\n",
|
||
|
// addr);
|
||
|
// return;
|
||
|
// }
|
||
|
DISPMSG("mt6382 read addr:0x%08x, val:0x%08x\n", addr, val);
|
||
|
|
||
|
} else if (strncmp(opt, "check", 5) == 0) {
|
||
|
if (check_stopstate(NULL) == 0)
|
||
|
bdg_tx_start(DISP_BDG_DSI0, NULL);
|
||
|
mdelay(100);
|
||
|
return;
|
||
|
#endif
|
||
|
} else if (strncmp(opt, "mobile:", 7) == 0) {
|
||
|
if (strncmp(opt + 7, "on", 2) == 0)
|
||
|
g_mobilelog = 1;
|
||
|
else if (strncmp(opt + 7, "off", 3) == 0)
|
||
|
g_mobilelog = 0;
|
||
|
} else if (strncmp(opt, "bypass_blank:", 13) == 0) {
|
||
|
char *p = (char *)opt + 13;
|
||
|
unsigned int blank;
|
||
|
|
||
|
ret = kstrtouint(p, 0, &blank);
|
||
|
if (ret) {
|
||
|
DISPWARN("%d error to parse cmd %s\n", __LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
if (blank)
|
||
|
bypass_blank = 1;
|
||
|
else
|
||
|
bypass_blank = 0;
|
||
|
} else if (strncmp(opt, "stop_fake_eng", 13) == 0) {
|
||
|
DISPMSG("STOP FAKE\n");
|
||
|
disp_fake_engine_stop();
|
||
|
} else if (strncmp(opt, "fake_eng:", 9) == 0) {
|
||
|
DISPMSG("START FAKE, THE CMD:%s", opt+9);
|
||
|
if (strncmp(opt + 9, "de", 2) == 0) {
|
||
|
disp_fake_engine_config(fb_pa, fb_pa+4, 1,
|
||
|
2047, 3, 0, 0, 0, 1);
|
||
|
} else {
|
||
|
unsigned int WR_mode = 0;
|
||
|
unsigned int loop_mode = 0;
|
||
|
unsigned int test_len = 0;
|
||
|
unsigned int burst_len = 0;
|
||
|
unsigned int latency = 0;
|
||
|
|
||
|
ret = sscanf(opt, "fake_eng:%d,%d,%d,%d,%d\n",
|
||
|
&WR_mode, &loop_mode, &test_len,
|
||
|
&burst_len, &latency);
|
||
|
if (ret != 5) {
|
||
|
pr_debug("%d error to parse cmd %s\n",
|
||
|
__LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
disp_fake_engine_config(fb_pa, fb_pa+1, 1,
|
||
|
test_len, burst_len, 0, 0, latency, loop_mode);
|
||
|
}
|
||
|
} else if (strncmp(opt, "force_fps:", 9) == 0) {
|
||
|
unsigned int keep;
|
||
|
unsigned int skip;
|
||
|
|
||
|
ret = sscanf(opt, "force_fps:%d,%d\n", &keep, &skip);
|
||
|
if (ret != 2) {
|
||
|
DISPWARN("%d error to parse cmd %s\n", __LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
DISPMSG("force set fps, keep %d, skip %d\n", keep, skip);
|
||
|
primary_display_force_set_fps(keep, skip);
|
||
|
} else if (strncmp(opt, "AAL_trigger", 11) == 0) {
|
||
|
int i = 0;
|
||
|
struct disp_session_vsync_config vsync_config;
|
||
|
|
||
|
for (i = 0; i < 1200; i++) {
|
||
|
primary_display_wait_for_vsync(&vsync_config);
|
||
|
dpmgr_module_notify(DISP_MODULE_AAL0,
|
||
|
DISP_PATH_EVENT_TRIGGER);
|
||
|
}
|
||
|
#ifdef CONFIG_MTK_DISPLAY_120HZ_SUPPORT
|
||
|
} else if (strncmp(opt, "odbypass:", 9) == 0) {
|
||
|
char *p = (char *)opt + 9;
|
||
|
int bypass = kstrtoul(p, 16, (unsigned long int *)&p);
|
||
|
|
||
|
primary_display_od_bypass(bypass);
|
||
|
DISPMSG("OD bypass: %d\n", bypass);
|
||
|
return;
|
||
|
#endif
|
||
|
} else if (strncmp(opt, "diagnose", 8) == 0) {
|
||
|
primary_display_diagnose();
|
||
|
return;
|
||
|
} else if (strncmp(opt, "_efuse_test", 11) == 0) {
|
||
|
primary_display_check_test();
|
||
|
} else if (strncmp(opt, "dprec_reset", 11) == 0) {
|
||
|
dprec_logger_reset_all();
|
||
|
return;
|
||
|
} else if (strncmp(opt, "suspend", 7) == 0) {
|
||
|
primary_display_suspend();
|
||
|
return;
|
||
|
} else if (strncmp(opt, "resume", 6) == 0) {
|
||
|
primary_display_resume();
|
||
|
} else if (strncmp(opt, "ata", 3) == 0) {
|
||
|
mtkfb_fm_auto_test();
|
||
|
return;
|
||
|
} else if (strncmp(opt, "dalprintf", 9) == 0) {
|
||
|
DAL_Printf("display aee layer test\n");
|
||
|
} else if (strncmp(opt, "dalclean", 8) == 0) {
|
||
|
DAL_Clean();
|
||
|
} else if (strncmp(opt, "daltest", 7) == 0) {
|
||
|
int i = 1000;
|
||
|
|
||
|
while (i--) {
|
||
|
DAL_Printf("display aee layer test\n");
|
||
|
msleep(20);
|
||
|
DAL_Clean();
|
||
|
msleep(20);
|
||
|
}
|
||
|
} else if (strncmp(opt, "lfr_setting:", 12) == 0) {
|
||
|
unsigned int enable;
|
||
|
unsigned int mode;
|
||
|
/* unsigned int mode=3; */
|
||
|
unsigned int type = 0;
|
||
|
unsigned int skip_num = 1;
|
||
|
|
||
|
ret = sscanf(opt, "lfr_setting:%d,%d\n", &enable, &mode);
|
||
|
if (ret != 2) {
|
||
|
DISPWARN("%d error to parse cmd %s\n", __LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
DDPMSG("--------------enable/disable lfr--------------\n");
|
||
|
if (enable) {
|
||
|
DDPMSG("lfr enable %d mode =%d\n", enable, mode);
|
||
|
enable = 1;
|
||
|
DSI_Set_LFR(DISP_MODULE_DSI0, NULL,
|
||
|
mode, type, enable, skip_num);
|
||
|
} else {
|
||
|
DDPMSG("lfr disable %d mode=%d\n", enable, mode);
|
||
|
enable = 0;
|
||
|
DSI_Set_LFR(DISP_MODULE_DSI0, NULL,
|
||
|
mode, type, enable, skip_num);
|
||
|
}
|
||
|
} else if (strncmp(opt, "vsync_switch:", 13) == 0) {
|
||
|
char *p = (char *)opt + 13;
|
||
|
unsigned int method = 0;
|
||
|
|
||
|
ret = kstrtouint(p, 0, &method);
|
||
|
if (ret) {
|
||
|
DISPWARN("%d error to parse cmd %s\n", __LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
primary_display_vsync_switch(method);
|
||
|
} else if (strncmp(opt, "dsi0_clk:", 9) == 0) {
|
||
|
char *p = (char *)opt + 9;
|
||
|
UINT32 clk;
|
||
|
|
||
|
ret = kstrtouint(p, 0, &clk);
|
||
|
if (ret) {
|
||
|
DISPWARN("%d error to parse cmd %s\n", __LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
} else if (strncmp(opt, "dst_switch:", 11) == 0) {
|
||
|
char *p = (char *)opt + 11;
|
||
|
UINT32 mode;
|
||
|
|
||
|
ret = kstrtouint(p, 0, &mode);
|
||
|
if (ret) {
|
||
|
DISPWARN("%d error to parse cmd %s\n", __LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
primary_display_switch_dst_mode(mode % 2);
|
||
|
return;
|
||
|
} else if (strncmp(opt, "cv_switch:", 10) == 0) {
|
||
|
char *p = (char *)opt + 10;
|
||
|
UINT32 mode;
|
||
|
|
||
|
ret = kstrtouint(p, 0, &mode);
|
||
|
if (ret) {
|
||
|
DISPWARN("%d error to parse cmd %s\n", __LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
disp_helper_set_option(DISP_OPT_CV_BYSUSPEND, mode % 2);
|
||
|
return;
|
||
|
} else if (strncmp(opt, "cmmva_dprec", 11) == 0) {
|
||
|
dprec_handle_option(0x7);
|
||
|
} else if (strncmp(opt, "cmmpa_dprec", 11) == 0) {
|
||
|
dprec_handle_option(0x3);
|
||
|
} else if (strncmp(opt, "dprec", 5) == 0) {
|
||
|
char *p = (char *)opt + 6;
|
||
|
unsigned int option;
|
||
|
|
||
|
ret = kstrtouint(p, 0, &option);
|
||
|
if (ret) {
|
||
|
DISPWARN("%d error to parse cmd %s\n", __LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
dprec_handle_option(option);
|
||
|
} else if (strncmp(opt, "maxlayer", 8) == 0) {
|
||
|
char *p = (char *)opt + 9;
|
||
|
unsigned int maxlayer;
|
||
|
|
||
|
ret = kstrtouint(p, 0, &maxlayer);
|
||
|
if (ret) {
|
||
|
DISPWARN("%d error to parse cmd %s\n", __LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
if (maxlayer)
|
||
|
primary_display_set_max_layer(maxlayer);
|
||
|
else
|
||
|
DISPWARN("can't set max layer to 0\n");
|
||
|
} else if (strncmp(opt, "primary_reset", 13) == 0) {
|
||
|
primary_display_reset();
|
||
|
} else if (strncmp(opt, "esd_check", 9) == 0) {
|
||
|
char *p = (char *)opt + 10;
|
||
|
unsigned int enable;
|
||
|
|
||
|
ret = kstrtouint(p, 0, &enable);
|
||
|
if (ret) {
|
||
|
DISPWARN("%d error to parse cmd %s\n", __LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
primary_display_esd_check_enable(enable);
|
||
|
} else if (strncmp(opt, "esd_recovery", 12) == 0) {
|
||
|
primary_display_esd_recovery();
|
||
|
} else if (strncmp(opt, "set_esd_mode:", 13) == 0) {
|
||
|
char *p = (char *)opt + 13;
|
||
|
unsigned int mode;
|
||
|
|
||
|
ret = kstrtouint(p, 0, &mode);
|
||
|
if (ret) {
|
||
|
DISPWARN("%d error to parse cmd %s\n", __LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
set_esd_check_mode(mode);
|
||
|
} else if (strncmp(opt, "lcm0_reset", 10) == 0) {
|
||
|
DISPCHECK("lcm0_reset\n");
|
||
|
#if 0
|
||
|
primary_display_idlemgr_kick(__func__, 1);
|
||
|
DISP_CPU_REG_SET(DISP_REG_CONFIG_MMSYS_LCM_RST_B, 1);
|
||
|
msleep(20);
|
||
|
DISP_CPU_REG_SET(DISP_REG_CONFIG_MMSYS_LCM_RST_B, 0);
|
||
|
msleep(20);
|
||
|
DISP_CPU_REG_SET(DISP_REG_CONFIG_MMSYS_LCM_RST_B, 1);
|
||
|
#else
|
||
|
#ifdef CONFIG_MTK_LEGACY
|
||
|
mt_set_gpio_mode(GPIO106 | 0x80000000, GPIO_MODE_00);
|
||
|
mt_set_gpio_dir(GPIO106 | 0x80000000, GPIO_DIR_OUT);
|
||
|
mt_set_gpio_out(GPIO106 | 0x80000000, GPIO_OUT_ONE);
|
||
|
msleep(20);
|
||
|
mt_set_gpio_out(GPIO106 | 0x80000000, GPIO_OUT_ZERO);
|
||
|
msleep(20);
|
||
|
mt_set_gpio_out(GPIO106 | 0x80000000, GPIO_OUT_ONE);
|
||
|
#else
|
||
|
ret = disp_dts_gpio_select_state(DTS_GPIO_STATE_LCM_RST_OUT1);
|
||
|
msleep(20);
|
||
|
ret |= disp_dts_gpio_select_state(DTS_GPIO_STATE_LCM_RST_OUT0);
|
||
|
msleep(20);
|
||
|
ret |= disp_dts_gpio_select_state(DTS_GPIO_STATE_LCM_RST_OUT1);
|
||
|
#endif
|
||
|
#endif
|
||
|
} else if (strncmp(opt, "lcm0_reset0", 11) == 0) {
|
||
|
DISP_CPU_REG_SET(DISP_REG_CONFIG_MMSYS_LCM_RST_B, 0);
|
||
|
} else if (strncmp(opt, "lcm0_reset1", 11) == 0) {
|
||
|
DISP_CPU_REG_SET(DISP_REG_CONFIG_MMSYS_LCM_RST_B, 1);
|
||
|
} else if (strncmp(opt, "dump_layer:", 11) == 0) {
|
||
|
if (strncmp(opt + 11, "on", 2) == 0) {
|
||
|
ret = sscanf(opt, "dump_layer:on,%d,%d,%d\n",
|
||
|
&gCapturePriLayerDownX, &gCapturePriLayerDownY,
|
||
|
&gCapturePriLayerNum);
|
||
|
if (ret != 3) {
|
||
|
DISPWARN("%d error to parse cmd %s\n",
|
||
|
__LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
gCapturePriLayerEnable = 1;
|
||
|
gCaptureWdmaLayerEnable = 1;
|
||
|
if (gCapturePriLayerDownX == 0)
|
||
|
gCapturePriLayerDownX = 20;
|
||
|
if (gCapturePriLayerDownY == 0)
|
||
|
gCapturePriLayerDownY = 20;
|
||
|
DDPMSG("dump_layer En %d DownX %d DownY %d,Num %d",
|
||
|
gCapturePriLayerEnable, gCapturePriLayerDownX,
|
||
|
gCapturePriLayerDownY, gCapturePriLayerNum);
|
||
|
|
||
|
} else if (strncmp(opt + 11, "off", 3) == 0) {
|
||
|
gCapturePriLayerEnable = 0;
|
||
|
gCaptureWdmaLayerEnable = 0;
|
||
|
gCapturePriLayerNum = TOTAL_OVL_LAYER_NUM;
|
||
|
DDPMSG("dump_layer En %d\n", gCapturePriLayerEnable);
|
||
|
}
|
||
|
} else if (strncmp(opt, "dump_wdma_layer:", 16) == 0) {
|
||
|
if (strncmp(opt + 16, "on", 2) == 0) {
|
||
|
ret = sscanf(opt, "dump_wdma_layer:on,%d,%d\n",
|
||
|
&gCapturePriLayerDownX, &gCapturePriLayerDownY);
|
||
|
if (ret != 2) {
|
||
|
DISPWARN("%d error to parse cmd %s\n",
|
||
|
__LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
gCaptureWdmaLayerEnable = 1;
|
||
|
if (gCapturePriLayerDownX == 0)
|
||
|
gCapturePriLayerDownX = 20;
|
||
|
if (gCapturePriLayerDownY == 0)
|
||
|
gCapturePriLayerDownY = 20;
|
||
|
DDPMSG("dump_wdma_layer En %d DownX %d DownY %d",
|
||
|
gCaptureWdmaLayerEnable, gCapturePriLayerDownX,
|
||
|
gCapturePriLayerDownY);
|
||
|
|
||
|
} else if (strncmp(opt + 16, "off", 3) == 0) {
|
||
|
gCaptureWdmaLayerEnable = 0;
|
||
|
DDPMSG("dump_layer En %d\n", gCaptureWdmaLayerEnable);
|
||
|
}
|
||
|
} else if (strncmp(opt, "dump_rdma_layer:", 16) == 0) {
|
||
|
#if defined(CONFIG_MTK_ENG_BUILD) || !defined(CONFIG_MTK_GMO_RAM_OPTIMIZE)
|
||
|
if (strncmp(opt + 16, "on", 2) == 0) {
|
||
|
ret = sscanf(opt, "dump_rdma_layer:on,%d,%d\n",
|
||
|
&gCapturePriLayerDownX,
|
||
|
&gCapturePriLayerDownY);
|
||
|
if (ret != 2) {
|
||
|
DISPWARN("%d error to parse cmd %s\n",
|
||
|
__LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
gCaptureRdmaLayerEnable = 1;
|
||
|
if (gCapturePriLayerDownX == 0)
|
||
|
gCapturePriLayerDownX = 20;
|
||
|
if (gCapturePriLayerDownY == 0)
|
||
|
gCapturePriLayerDownY = 20;
|
||
|
DDPMSG("dump_wdma_layer En %d DownX %d DownY %d",
|
||
|
gCaptureRdmaLayerEnable, gCapturePriLayerDownX,
|
||
|
gCapturePriLayerDownY);
|
||
|
} else if (strncmp(opt + 16, "off", 3) == 0) {
|
||
|
gCaptureRdmaLayerEnable = 0;
|
||
|
DDPMSG("dump_layer En %d\n", gCaptureRdmaLayerEnable);
|
||
|
}
|
||
|
#endif
|
||
|
} else if (strncmp(opt, "enable_idlemgr:", 15) == 0) {
|
||
|
char *p = (char *)opt + 15;
|
||
|
UINT32 flg;
|
||
|
|
||
|
ret = kstrtouint(p, 0, &flg);
|
||
|
if (ret) {
|
||
|
DISPWARN("%d error to parse cmd %s\n", __LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
enable_idlemgr(flg);
|
||
|
} else if (strncmp(opt, "fps:", 4) == 0) {
|
||
|
char *p = (char *)opt+4;
|
||
|
int fps = kstrtoul(p, 10, (unsigned long int *)&p);
|
||
|
|
||
|
DDPMSG("change fps\n");
|
||
|
primary_display_set_lcm_refresh_rate(fps);
|
||
|
return;
|
||
|
} else if (strncmp(opt, "disp_mode:", 10) == 0) {
|
||
|
char *p = (char *)opt + 10;
|
||
|
unsigned long int disp_mode = 0;
|
||
|
|
||
|
ret = kstrtoul(p, 10, &disp_mode);
|
||
|
gTriggerDispMode = (int)disp_mode;
|
||
|
if (ret)
|
||
|
DISPWARN("DISP/%s: errno %d\n", __func__, ret);
|
||
|
|
||
|
DISPMSG("DDP: gTriggerDispMode=%d\n", gTriggerDispMode);
|
||
|
} else if (strncmp(opt, "disp_set_fps:", 13) == 0) {
|
||
|
char *p = (char *)opt + 13;
|
||
|
unsigned int disp_fps = 0;
|
||
|
|
||
|
ret = kstrtouint(p, 0, &disp_fps);
|
||
|
DDPMSG("Display debug command: disp_set_fps start\n");
|
||
|
primary_display_force_set_vsync_fps(disp_fps, 0);
|
||
|
DDPMSG("Display debug command: disp_set_fps done\n");
|
||
|
} else if (strncmp(opt, "disp_set_max_fps", 16) == 0) {
|
||
|
int fps = 0;
|
||
|
|
||
|
DDPMSG("Display debug command: disp_set_max_fps start\n");
|
||
|
fps = primary_display_get_max_refresh_rate();
|
||
|
primary_display_force_set_vsync_fps(fps, 0);
|
||
|
DDPMSG("Display debug command: disp_set_max_fps done\n");
|
||
|
} else if (strncmp(opt, "disp_set_min_fps", 16) == 0) {
|
||
|
int fps = 0;
|
||
|
|
||
|
DDPMSG("Display debug command: disp_set_min_fps start\n");
|
||
|
fps = primary_display_get_min_refresh_rate();
|
||
|
primary_display_force_set_vsync_fps(fps, 0);
|
||
|
DDPMSG("Display debug command: disp_set_min_fps done\n");
|
||
|
} else if (strncmp(opt, "disp_enter_idle_fps", 19) == 0) {
|
||
|
DDPMSG("Display debug command: disp_enter_idle_fps start\n");
|
||
|
primary_display_force_set_vsync_fps(50, 1);
|
||
|
DDPMSG("Display debug command: disp_enter_idle_fps done\n");
|
||
|
} else if (strncmp(opt, "disp_leave_idle_fps", 19) == 0) {
|
||
|
DDPMSG("Display debug command: disp_leave_idle_fps start\n");
|
||
|
primary_display_force_set_vsync_fps(60, 2);
|
||
|
DDPMSG("Display debug command: disp_leave_idle_fps done\n");
|
||
|
} else if (strncmp(opt, "disp_get_fps", 12) == 0) {
|
||
|
unsigned int disp_fps = 0;
|
||
|
|
||
|
DDPMSG("Display debug command: disp_get_fps start\n");
|
||
|
disp_fps = primary_display_force_get_vsync_fps();
|
||
|
DDPMSG(
|
||
|
"Display debug command: disp_get_fps done, disp_fps=%d\n",
|
||
|
disp_fps);
|
||
|
} else if (strncmp(opt, "set_emi_bound_tb:", 17) == 0) {
|
||
|
do_set_emi_bound_tb_opt(opt);
|
||
|
} else if (strncmp(opt, "primary_basic_test:", 19) == 0) {
|
||
|
unsigned int layer_num, w, h, fmt, frame_num;
|
||
|
unsigned int vsync_num, x, y, r, g, b, a;
|
||
|
unsigned int layer_en_mask, cksum;
|
||
|
int mode;
|
||
|
|
||
|
ret = sscanf(opt,
|
||
|
"primary_basic_test:%d,0x%x,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,0x%x\n",
|
||
|
&layer_num, &layer_en_mask, &w, &h,
|
||
|
&fmt, &frame_num, &vsync_num,
|
||
|
&x, &y, &r, &g, &b, &a, &mode, &cksum);
|
||
|
if (ret != 15 && ret != 1) {
|
||
|
DISPWARN("error to parse cmd %s, ret=%d\n", opt, ret);
|
||
|
return;
|
||
|
}
|
||
|
if (ret == 1 && layer_num == 0) {
|
||
|
basic_test_cancel = 1;
|
||
|
return;
|
||
|
}
|
||
|
basic_test_cancel = 0;
|
||
|
|
||
|
if (mode == DISP_INVALID_SESSION_MODE ||
|
||
|
mode >= DISP_SESSION_MODE_NUM)
|
||
|
mode = DISP_SESSION_DIRECT_LINK_MODE;
|
||
|
|
||
|
if (fmt == 0)
|
||
|
fmt = DISP_FORMAT_RGBA8888;
|
||
|
else if (fmt == 1)
|
||
|
fmt = DISP_FORMAT_RGB888;
|
||
|
else if (fmt == 2)
|
||
|
fmt = DISP_FORMAT_RGB565;
|
||
|
|
||
|
primary_display_basic_test(layer_num, layer_en_mask,
|
||
|
w, h, fmt, frame_num, vsync_num,
|
||
|
x, y, r, g, b, a, mode, cksum);
|
||
|
}
|
||
|
|
||
|
if (strncmp(opt, "pan_disp_test:", 13) == 0) {
|
||
|
int frame_num;
|
||
|
int bpp;
|
||
|
|
||
|
ret = sscanf(opt, "pan_disp_test:%d,%d\n", &frame_num, &bpp);
|
||
|
if (ret != 2) {
|
||
|
DISPERR("%d error to parse cmd %s\n", __LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
pan_display_test(frame_num, bpp);
|
||
|
}
|
||
|
|
||
|
if (strncmp(opt, "dsi_ut:restart_vdo_mode", 23) == 0) {
|
||
|
dpmgr_path_stop(primary_get_dpmgr_handle(), CMDQ_DISABLE);
|
||
|
primary_display_diagnose();
|
||
|
dpmgr_path_start(primary_get_dpmgr_handle(), CMDQ_DISABLE);
|
||
|
dpmgr_path_trigger(primary_get_dpmgr_handle(),
|
||
|
NULL, CMDQ_DISABLE);
|
||
|
}
|
||
|
|
||
|
if (strncmp(opt, "dsi_ut:restart_cmd_mode", 23) == 0) {
|
||
|
dpmgr_path_stop(primary_get_dpmgr_handle(), CMDQ_DISABLE);
|
||
|
primary_display_diagnose();
|
||
|
|
||
|
dpmgr_path_start(primary_get_dpmgr_handle(), CMDQ_DISABLE);
|
||
|
dpmgr_path_trigger(primary_get_dpmgr_handle(),
|
||
|
NULL, CMDQ_DISABLE);
|
||
|
dpmgr_path_stop(primary_get_dpmgr_handle(), CMDQ_DISABLE);
|
||
|
primary_display_diagnose();
|
||
|
|
||
|
dpmgr_path_start(primary_get_dpmgr_handle(), CMDQ_DISABLE);
|
||
|
dpmgr_path_trigger(primary_get_dpmgr_handle(),
|
||
|
NULL, CMDQ_DISABLE);
|
||
|
}
|
||
|
|
||
|
if (strncmp(opt, "scenario:", 8) == 0) {
|
||
|
int scen;
|
||
|
|
||
|
ret = sscanf(opt, "scenario:%d\n", &scen);
|
||
|
if (ret != 1) {
|
||
|
DISPWARN("%d error to parse cmd %s\n",
|
||
|
__LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
primary_display_set_scenario(scen);
|
||
|
}
|
||
|
if (strncmp(opt, "layout_noncontinous:", 20) == 0) {
|
||
|
ret = sscanf(opt, "layout_noncontinuous:%d\n",
|
||
|
&layer_layout_allow_non_continuous);
|
||
|
if (ret != 1) {
|
||
|
DISPWARN("%d error to parse cmd %s\n",
|
||
|
__LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
}
|
||
|
if (strncmp(opt, "idle_wait:", 10) == 0) {
|
||
|
ret = sscanf(opt, "idle_wait:%lld\n", &idle_check_interval);
|
||
|
if (ret != 1) {
|
||
|
DISPWARN("%d error to parse cmd %s\n",
|
||
|
__LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
idle_check_interval =
|
||
|
idle_check_interval < 17 ? 17 : idle_check_interval;
|
||
|
DISPMSG("change idle interval to %lldms\n",
|
||
|
idle_check_interval);
|
||
|
}
|
||
|
if (strncmp(opt, "layer_statistic:", 16) == 0) {
|
||
|
ret = sscanf(opt, "layer_statistic:%d\n",
|
||
|
&layer_statistic_enable);
|
||
|
if (ret != 1) {
|
||
|
DISPWARN("%d error to parse cmd %s\n", __LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
if (!layer_statistic_enable)
|
||
|
disp_layer_info_statistic_reset();
|
||
|
}
|
||
|
if (strncmp(opt, "check_clk", 9) == 0)
|
||
|
ddp_clk_check();
|
||
|
if (strncmp(opt, "round_corner_offset_debug:", 26) == 0) {
|
||
|
if (strncmp(opt + 26, "on", 2) == 0)
|
||
|
round_corner_offset_enable = 1;
|
||
|
else if (strncmp(opt + 26, "off", 3) == 0)
|
||
|
round_corner_offset_enable = 0;
|
||
|
} else if (strncmp(opt, "MIPI_CLK:", 9) == 0) {
|
||
|
if (strncmp(opt + 9, "on", 2) == 0)
|
||
|
mipi_clk_change(0, 1);
|
||
|
else if (strncmp(opt + 9, "off", 3) == 0)
|
||
|
mipi_clk_change(0, 0);
|
||
|
}
|
||
|
if (strncmp(opt, "change_mipi_date_rate:", 16) == 0) {
|
||
|
int mipi_date_rate = 0;
|
||
|
|
||
|
ret = sscanf(opt, "change_mipi_date_rate:%d\n",
|
||
|
&mipi_date_rate);
|
||
|
if (ret != 1) {
|
||
|
DISPWARN("%d error to parse cmd %s\n",
|
||
|
__LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
if (mipi_date_rate == 0)
|
||
|
mipi_clk_change_by_data_rate(0, mipi_date_rate);
|
||
|
else
|
||
|
mipi_clk_change_by_data_rate(1, mipi_date_rate);
|
||
|
|
||
|
DISPMSG("change mipi_date_rate to %dMhz\n",
|
||
|
mipi_date_rate);
|
||
|
} else if (strncmp(opt, "dump_output:", 12) == 0) {
|
||
|
if (strncmp(opt + 12, "on", 2) == 0)
|
||
|
dump_output = 1;
|
||
|
else if (strncmp(opt + 12, "off", 3) == 0) {
|
||
|
if (composed_buf) {
|
||
|
vfree(composed_buf);
|
||
|
composed_buf = NULL;
|
||
|
}
|
||
|
dump_output = 0;
|
||
|
} else if (strncmp(opt + 12, "save", 4) == 0) {
|
||
|
int w, h, bytes;
|
||
|
struct file *bmp;
|
||
|
|
||
|
if (dump_output == 0)
|
||
|
dump_output = 1;
|
||
|
w = disp_helper_get_option(DISP_OPT_FAKE_LCM_WIDTH);
|
||
|
h = disp_helper_get_option(DISP_OPT_FAKE_LCM_HEIGHT);
|
||
|
bytes = w * h * 3;
|
||
|
if (composed_buf == NULL)
|
||
|
composed_buf = vmalloc(bytes);
|
||
|
init_completion(&dump_buf_comp);
|
||
|
dump_output_comp = 1;
|
||
|
wait_for_completion(&dump_buf_comp);
|
||
|
bmp = filp_open("/sdcard/dump_output.bmp",
|
||
|
O_CREAT | O_RDWR, 0);
|
||
|
if (IS_ERR(bmp)) {
|
||
|
vfree(composed_buf);
|
||
|
composed_buf = NULL;
|
||
|
return;
|
||
|
}
|
||
|
filp_close(bmp, NULL);
|
||
|
bmp_adjust(composed_buf, bytes, w, h);
|
||
|
save_bmp("/sdcard/dump_output.bmp", composed_buf, w, h);
|
||
|
} else
|
||
|
DISPERR("error to parse cmd %s\n", opt);
|
||
|
#ifdef CONFIG_MTK_HIGH_FRAME_RATE
|
||
|
} else if (!strncmp(opt, "set_cfg_id:", 11)) {
|
||
|
char *p = (char *)opt + 11;
|
||
|
unsigned int cfg_id = 0;
|
||
|
|
||
|
ret = kstrtouint(p, 10, &cfg_id);
|
||
|
if (ret) {
|
||
|
DISPWARN("%d error to parse cmd %s\n", __LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
DDPMSG("debug:set_cfg_id:%d start\n", cfg_id);
|
||
|
primary_display_dynfps_chg_fps(cfg_id);
|
||
|
g_force_cfg_id = cfg_id;
|
||
|
DDPMSG("debug:set_cfg_id:%d end\n", cfg_id);
|
||
|
} else if (!strncmp(opt, "enable_force_fps:", 17)) {
|
||
|
char *p = (char *)opt + 17;
|
||
|
unsigned int enable_force_fps = 0;
|
||
|
|
||
|
ret = kstrtouint(p, 10, &enable_force_fps);
|
||
|
|
||
|
if (ret) {
|
||
|
DISPWARN("%d error to parse cmd %s\n", __LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
g_force_cfg = !!enable_force_fps;
|
||
|
DDPMSG("debug:g_force_cfg:%d\n", g_force_cfg);
|
||
|
|
||
|
} else if (!strncmp(opt, "get_multi_cfg", 13)) {
|
||
|
struct multi_configs cfgs;
|
||
|
unsigned int i = 0;
|
||
|
struct dyn_config_info *dyn_info = NULL;
|
||
|
|
||
|
memset(&cfgs, 0, sizeof(cfgs));
|
||
|
primary_display_get_multi_configs(&cfgs);
|
||
|
|
||
|
DISPMSG("debug:get_multi_cfg:=%d\n", cfgs.config_num);
|
||
|
|
||
|
for (i = 0; i < cfgs.config_num &&
|
||
|
cfgs.config_num <= MULTI_CONFIG_NUM; i++) {
|
||
|
dyn_info = &(cfgs.dyn_cfgs[i]);
|
||
|
DISPMSG("debug:%d,%dfps\n", i, dyn_info->vsyncFPS);
|
||
|
}
|
||
|
#endif
|
||
|
}
|
||
|
#ifdef CONFIG_MTK_ENG_BUILD
|
||
|
if (strncmp(opt, "rdma_threshold:", 15) == 0) {
|
||
|
ret = sscanf(opt, "rdma_threshold:%d,%d,%d,%d,%d\n",
|
||
|
&dbg_ultlow, &dbg_ulthigh, &dbg_prehigh,
|
||
|
&dbg_urg_low, &dbg_urg_high);
|
||
|
if (ret != 5) {
|
||
|
DISPWARN("%d error to parse cmd %s\n", __LINE__, opt);
|
||
|
return;
|
||
|
}
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
}
|
||
|
|
||
|
static void process_dbg_cmd(char *cmd)
|
||
|
{
|
||
|
char *tok;
|
||
|
|
||
|
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DBG", "[mtkfb_dbg] %s\n", cmd);
|
||
|
|
||
|
while ((tok = strsep(&cmd, " ")) != NULL)
|
||
|
process_dbg_opt(tok);
|
||
|
}
|
||
|
|
||
|
static int debug_open(struct inode *inode, struct file *file)
|
||
|
{
|
||
|
file->private_data = inode->i_private;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
int debug_get_info(unsigned char *stringbuf, int buf_len)
|
||
|
{
|
||
|
int n = 0;
|
||
|
|
||
|
DISPFUNC();
|
||
|
|
||
|
n += mtkfb_get_debug_state(stringbuf + n,
|
||
|
buf_len - n);
|
||
|
|
||
|
n += primary_display_get_debug_state(stringbuf + n,
|
||
|
buf_len - n);
|
||
|
|
||
|
n += disp_sync_get_debug_info(stringbuf + n,
|
||
|
buf_len - n);
|
||
|
|
||
|
n += dprec_logger_get_result_string_all(stringbuf + n,
|
||
|
buf_len - n);
|
||
|
|
||
|
n += disp_helper_get_option_list(stringbuf + n,
|
||
|
buf_len - n);
|
||
|
|
||
|
n += dprec_logger_get_buf(DPREC_LOGGER_ERROR,
|
||
|
stringbuf + n, buf_len - n);
|
||
|
|
||
|
n += dprec_logger_get_buf(DPREC_LOGGER_FENCE,
|
||
|
stringbuf + n, buf_len - n);
|
||
|
|
||
|
n += dprec_logger_get_buf(DPREC_LOGGER_DUMP,
|
||
|
stringbuf + n, buf_len - n);
|
||
|
|
||
|
n += dprec_logger_get_buf(DPREC_LOGGER_DEBUG,
|
||
|
stringbuf + n, buf_len - n);
|
||
|
|
||
|
n += dprec_logger_get_buf(DPREC_LOGGER_STATUS,
|
||
|
stringbuf + n, buf_len - n);
|
||
|
|
||
|
stringbuf[n++] = 0;
|
||
|
return n;
|
||
|
}
|
||
|
|
||
|
void debug_info_dump_to_printk(char *buf, int buf_len)
|
||
|
{
|
||
|
int i = 0;
|
||
|
int n = buf_len;
|
||
|
|
||
|
for (i = 0; i < n; i += 256)
|
||
|
DISPMSG("%s", buf + i);
|
||
|
}
|
||
|
|
||
|
static ssize_t debug_read(struct file *file,
|
||
|
char __user *ubuf, size_t count, loff_t *ppos)
|
||
|
{
|
||
|
int debug_bufmax;
|
||
|
static int n;
|
||
|
|
||
|
/* Debugfs read only fetch 4096 byte each time,
|
||
|
* thus whole ringbuffer need massive iteration.
|
||
|
* We only copy ringbuffer content to debugfs
|
||
|
* buffer at first time (*ppos = 0)
|
||
|
*/
|
||
|
if (*ppos != 0 || !is_buffer_init)
|
||
|
goto out;
|
||
|
|
||
|
DISPFUNC();
|
||
|
|
||
|
debug_bufmax = DEBUG_BUFFER_SIZE - 1;
|
||
|
n = debug_get_info(debug_buffer, debug_bufmax);
|
||
|
/* debug_info_dump_to_printk(); */
|
||
|
out:
|
||
|
return simple_read_from_buffer(ubuf, count, ppos, debug_buffer, n);
|
||
|
}
|
||
|
|
||
|
#if defined(CONFIG_SMCDSD_PANEL)
|
||
|
int mtkfb_debug_show(struct seq_file *m, void *unused)
|
||
|
{
|
||
|
int debug_bufmax;
|
||
|
static int n;
|
||
|
|
||
|
if (!is_buffer_init)
|
||
|
goto out;
|
||
|
|
||
|
DISPFUNC();
|
||
|
|
||
|
debug_bufmax = DEBUG_BUFFER_SIZE - 1;
|
||
|
n = debug_get_info(debug_buffer, debug_bufmax);
|
||
|
/* debug_info_dump_to_printk(); */
|
||
|
out:
|
||
|
//return simple_read_from_buffer(ubuf, count, ppos, debug_buffer, n);
|
||
|
seq_puts(m, "------ DISPLAY DEBUG INFO (/proc/mtkfb) ------\n");
|
||
|
if (debug_buffer)
|
||
|
seq_puts(m, debug_buffer);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
EXPORT_SYMBOL(mtkfb_debug_show);
|
||
|
#endif
|
||
|
|
||
|
static ssize_t debug_write(struct file *file,
|
||
|
const char __user *ubuf, size_t count, loff_t *ppos)
|
||
|
{
|
||
|
const int debug_bufmax = 512 - 1;
|
||
|
size_t ret;
|
||
|
char cmd_buffer[512];
|
||
|
|
||
|
ret = count;
|
||
|
|
||
|
if (count > debug_bufmax)
|
||
|
count = debug_bufmax;
|
||
|
|
||
|
if (copy_from_user(&cmd_buffer, ubuf, count))
|
||
|
return -EFAULT;
|
||
|
|
||
|
cmd_buffer[count] = 0;
|
||
|
|
||
|
process_dbg_cmd(cmd_buffer);
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
|
||
|
static const struct file_operations debug_fops = {
|
||
|
.read = debug_read,
|
||
|
.write = debug_write,
|
||
|
.open = debug_open,
|
||
|
};
|
||
|
|
||
|
static ssize_t kick_read(struct file *file,
|
||
|
char __user *ubuf, size_t count, loff_t *ppos)
|
||
|
{
|
||
|
return simple_read_from_buffer(ubuf,
|
||
|
count, ppos, get_kick_dump(), get_kick_dump_size());
|
||
|
}
|
||
|
|
||
|
static const struct file_operations kickidle_fops = {
|
||
|
.read = kick_read,
|
||
|
};
|
||
|
|
||
|
static ssize_t partial_read(struct file *file,
|
||
|
char __user *ubuf, size_t count, loff_t *ppos)
|
||
|
{
|
||
|
char p[10];
|
||
|
int support = 0;
|
||
|
struct disp_rect roi = {0, 0, 0, 0};
|
||
|
|
||
|
if (disp_partial_is_support()) {
|
||
|
if (!ddp_debug_force_roi()) {
|
||
|
support = 1;
|
||
|
} else {
|
||
|
roi.x = ddp_debug_force_roi_x();
|
||
|
roi.y = ddp_debug_force_roi_y();
|
||
|
roi.width = ddp_debug_force_roi_w();
|
||
|
roi.height = ddp_debug_force_roi_h();
|
||
|
if (!is_equal_full_lcm(&roi))
|
||
|
support = 1;
|
||
|
}
|
||
|
}
|
||
|
snprintf(p, 10, "%d\n", support);
|
||
|
return simple_read_from_buffer(ubuf, count, ppos, p, strlen(p));
|
||
|
}
|
||
|
|
||
|
static const struct file_operations partial_fops = {
|
||
|
.read = partial_read,
|
||
|
};
|
||
|
|
||
|
static int idletime_set(void *data, u64 val)
|
||
|
{
|
||
|
if (val < 33)
|
||
|
val = 33;
|
||
|
if (val > 1000000)
|
||
|
val = 1000000;
|
||
|
|
||
|
idle_check_interval = val;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int idletime_get(void *data, u64 *val)
|
||
|
{
|
||
|
*val = idle_check_interval;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
DEFINE_SIMPLE_ATTRIBUTE(idletime_fops, idletime_get, idletime_set, "%llu\n");
|
||
|
|
||
|
static int idlevfp_set(void *data, u64 val)
|
||
|
{
|
||
|
|
||
|
if (val > 4095)
|
||
|
val = 4095;
|
||
|
|
||
|
backup_vfp_for_lp_cust((unsigned int)val);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int idlevfp_get(void *data, u64 *val)
|
||
|
{
|
||
|
*val = (u64)get_backup_vfp();
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
DEFINE_SIMPLE_ATTRIBUTE(idlevfp_fops, idlevfp_get, idlevfp_set, "%llu\n");
|
||
|
|
||
|
void DBG_Init(void)
|
||
|
{
|
||
|
#if IS_ENABLED(CONFIG_DEBUG_FS)
|
||
|
struct dentry *d_folder;
|
||
|
struct dentry *d_file;
|
||
|
|
||
|
mtkfb_dbgfs = debugfs_create_file("mtkfb",
|
||
|
S_IFREG | 0444, NULL, (void *)0, &debug_fops);
|
||
|
|
||
|
d_folder = debugfs_create_dir("displowpower", NULL);
|
||
|
if (d_folder) {
|
||
|
d_file = debugfs_create_file("kickdump",
|
||
|
S_IFREG | 0444, d_folder, NULL, &kickidle_fops);
|
||
|
d_file = debugfs_create_file("partial",
|
||
|
S_IFREG | 0444, d_folder, NULL, &partial_fops);
|
||
|
d_file = debugfs_create_file("idletime",
|
||
|
S_IFREG | 0666, d_folder, NULL, &idletime_fops);
|
||
|
d_file = debugfs_create_file("idlevfp",
|
||
|
S_IFREG | 0666, d_folder, NULL, &idlevfp_fops);
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
//do samething in procfs
|
||
|
#if IS_ENABLED(CONFIG_PROC_FS)
|
||
|
mtkfb_procfs = proc_create("mtkfb", S_IFREG | 0444,
|
||
|
NULL,
|
||
|
&debug_fops);
|
||
|
if (!mtkfb_procfs) {
|
||
|
pr_info("[%s %d]failed to create mtkfb in /proc/disp_ddp\n",
|
||
|
__func__, __LINE__);
|
||
|
goto out;
|
||
|
}
|
||
|
|
||
|
disp_lowpower_proc = proc_mkdir("displowpower", NULL);
|
||
|
if (!disp_lowpower_proc) {
|
||
|
pr_info("[%s %d]failed to create dir: /proc/displowpower\n",
|
||
|
__func__, __LINE__);
|
||
|
goto out;
|
||
|
}
|
||
|
|
||
|
if (!proc_create("kickdump", S_IFREG | 0444,
|
||
|
disp_lowpower_proc, &kickidle_fops)) {
|
||
|
pr_info("[%s %d]failed to create kickdump in /proc/displowpower\n",
|
||
|
__func__, __LINE__);
|
||
|
goto out;
|
||
|
}
|
||
|
|
||
|
if (!proc_create("partial", S_IFREG | 0444,
|
||
|
disp_lowpower_proc, &partial_fops)) {
|
||
|
pr_info("[%s %d]failed to create partial in /proc/displowpower\n",
|
||
|
__func__, __LINE__);
|
||
|
goto out;
|
||
|
}
|
||
|
|
||
|
if (!proc_create("idletime", S_IFREG | 0444,
|
||
|
disp_lowpower_proc, &idletime_fops)) {
|
||
|
pr_info("[%s %d]failed to create idletime in /proc/displowpower\n",
|
||
|
__func__, __LINE__);
|
||
|
goto out;
|
||
|
}
|
||
|
|
||
|
if (!proc_create("idlevfp", S_IFREG | 0444,
|
||
|
disp_lowpower_proc, &idlevfp_fops)) {
|
||
|
pr_info("[%s %d]failed to create idlevfp in /proc/displowpower\n",
|
||
|
__func__, __LINE__);
|
||
|
goto out;
|
||
|
}
|
||
|
|
||
|
out:
|
||
|
return;
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
void DBG_Deinit(void)
|
||
|
{
|
||
|
#if IS_ENABLED(CONFIG_DEBUG_FS)
|
||
|
debugfs_remove(mtkfb_dbgfs);
|
||
|
#endif
|
||
|
|
||
|
#if IS_ENABLED(CONFIG_PROC_FS)
|
||
|
if (mtkfb_procfs) {
|
||
|
proc_remove(mtkfb_procfs);
|
||
|
mtkfb_procfs = NULL;
|
||
|
}
|
||
|
if (disp_lowpower_proc) {
|
||
|
proc_remove(disp_lowpower_proc);
|
||
|
disp_lowpower_proc = NULL;
|
||
|
}
|
||
|
|
||
|
#endif
|
||
|
}
|