aubrey/kernel_samsung_a34x-permissive
1
0
Fork 0
Code Issues Pull requests Actions Packages Projects Releases Wiki Activity
kernel_samsung_a34x-permissive/drivers/misc/mediatek/video/mt6739/videox/debug.c

1360 lines
36 KiB
C
Raw Normal View History

Import A346BXXU1AWB9 kernel source Android 13
2024-04-28 06:49:01 -07:00
/* 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 "m4u.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"
#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 */
int 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;
}
struct test_buf_info {
struct ion_client *ion_client;
struct m4u_client_t *m4u_client;
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)
{
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)) {
DISPERR("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) {
DISPERR("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) {
DISPERR("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) {
DISPERR("Fatal Error, get mva failed\n");
ion_free(client, handle);
ion_client_destroy(client);
return -1;
}
buf_info->handle = handle;
return 0;
}
static int alloc_buffer_from_dma(size_t size, struct test_buf_info *buf_info)
{
int ret = 0;
unsigned long size_align;
size_align = round_up(size, PAGE_SIZE);
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;
}
if (disp_helper_get_option(DISP_OPT_USE_M4U)) {
static struct sg_table table;
struct sg_table *sg_table = &table;
unsigned int mva;
ret = sg_alloc_table(sg_table, 1, GFP_KERNEL);
if (ret) {
DISPERR("allocate sg table failed: %d\n", ret);
return ret;
}
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))
DISPERR("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)
DISPERR("m4u_alloc_mva returns fail: %d\n", ret);
buf_info->buf_mva = mva;
DISPMSG("%s MVA is 0x%x PA is 0x%pa\n", __func__, mva,
&buf_info->buf_pa);
}
return 0;
}
static int release_test_buf(struct test_buf_info *buf_info)
{
/* 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);
if (buf_info->m4u_client)
m4u_destroy_client(buf_info->m4u_client);
if (buf_info->ion_client)
ion_client_destroy(buf_info->ion_client);
return 0;
}
static int primary_display_basic_test(int layer_num, 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)
{
struct disp_session_input_config *input_config;
int session_id = MAKE_DISP_SESSION(DISP_SESSION_PRIMARY, 0);
unsigned int Bpp;
int frame, i, ret;
enum UNIFIED_COLOR_FMT ufmt;
/* allocate buffer */
unsigned long size;
unsigned char *buf_va;
dma_addr_t buf_pa;
unsigned int buf_mva;
struct test_buf_info buf_info;
ufmt = disp_fmt_to_unified_fmt(fmt);
Bpp = UFMT_GET_bpp(ufmt) / 8;
size = w * h * Bpp;
DISPMSG("%s: layer_num=%u,w=%d,h=%d,fmt=%s,frame_num=%d,vsync=%d, size=%lu\n",
__func__, layer_num, w, h, unified_color_fmt_name(ufmt),
frame_num, vsync_num, size);
input_config = kmalloc(sizeof(*input_config), GFP_KERNEL);
if (!input_config)
return -ENOMEM;
memset(&buf_info, 0, sizeof(buf_info));
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)
DISPERR("error to alloc buffer size = %lu\n", size);
buf_va = buf_info.buf_va;
buf_pa = buf_info.buf_pa;
buf_mva = (unsigned int)buf_info.buf_mva;
draw_buffer(buf_va, w, h, ufmt, r, g, b, a);
for (frame = 0; frame < frame_num; frame++) {
memset(input_config, 0, sizeof(*input_config));
input_config->config_layer_num = layer_num;
input_config->session_id = session_id;
for (i = 0; i < layer_num; i++) {
int enable;
if (i == frame % (layer_num + 1) - 1)
enable = 1;
else
enable = 1;
input_config->config[i].layer_id = i;
input_config->config[i].layer_enable = enable;
input_config->config[i].src_base_addr = 0;
if (disp_helper_get_option(DISP_OPT_USE_M4U))
input_config->config[i].src_phy_addr =
(void *)((unsigned long)buf_mva);
else
input_config->config[i].src_phy_addr =
(void *)((unsigned long)buf_pa);
input_config->config[i].next_buff_idx = -1;
input_config->config[i].src_fmt = fmt;
input_config->config[i].src_pitch = w;
input_config->config[i].src_offset_x = 0;
input_config->config[i].src_offset_y = 0;
input_config->config[i].src_width = w;
input_config->config[i].src_height = h;
input_config->config[i].tgt_offset_x = i * offset_x;
input_config->config[i].tgt_offset_y = i * offset_y;
input_config->config[i].tgt_width = w;
input_config->config[i].tgt_height = h;
input_config->config[i].alpha_enable = 1;
input_config->config[i].alpha = 0xff;
input_config->config[i].security = DISP_NORMAL_BUFFER;
input_config->config[i].ext_sel_layer = -1;
}
primary_display_config_input_multiple(input_config);
primary_display_trigger(0, NULL, 0);
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);
}
}
/* disable all layers */
memset(input_config, 0, sizeof(*input_config));
input_config->config_layer_num = layer_num;
for (i = 0; i < layer_num; i++)
input_config->config[i].layer_id = i;
primary_display_config_input_multiple(input_config);
primary_display_trigger(1, NULL, 0);
release_test_buf(&buf_info);
kfree(input_config);
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 process_dbg_opt(const char *opt)
{
int ret;
if (strncmp(opt, "helper", 6) == 0) {
/*ex: echo helper:DISP_OPT_BYPASS_OVL,0 > /d/mtkfb */
char option[100] = "";
char *tmp;
int value, i;
tmp = (char *)(opt + 7);
for (i = 0; i < 100; i++) {
if (tmp[i] != ',' && tmp[i] != ' ')
option[i] = tmp[i];
else
break;
}
tmp += i + 1;
ret = sscanf(tmp, "%d\n", &value);
if (ret != 1) {
pr_debug("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);
} 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) {
pr_debug("%d error to parse cmd %s\n", __LINE__, opt);
return;
}
primary_display_switch_mode(sess_mode, session_id, 1);
} 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) {
pr_debug("%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", 10) == 0) {
char *p = (char *)opt + 11;
unsigned int pattern;
ret = kstrtouint(p, 0, &pattern);
if (ret) {
pr_debug("%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;
}
} 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) {
pr_debug("%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) {
pr_debug("%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) {
pr_debug("%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) {
pr_debug("%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) {
pr_debug("%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) {
pr_debug("%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) {
pr_debug("%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) {
pr_debug("%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) {
pr_debug("%d error to parse cmd %s\n", __LINE__, opt);
return;
}
if (maxlayer)
primary_display_set_max_layer(maxlayer);
else
DISPERR("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) {
pr_debug("%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) {
pr_debug("%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 1
DISP_CPU_REG_SET(DISPSYS_CONFIG_BASE + 0x150, 1);
msleep(20);
DISP_CPU_REG_SET(DISPSYS_CONFIG_BASE + 0x150, 0);
msleep(20);
DISP_CPU_REG_SET(DISPSYS_CONFIG_BASE + 0x150, 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(DISPSYS_CONFIG_BASE + 0x150, 0);
} else if (strncmp(opt, "lcm0_reset1", 11) == 0) {
DISP_CPU_REG_SET(DISPSYS_CONFIG_BASE + 0x150, 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) {
pr_debug("%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) {
pr_debug("%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) {
pr_debug("%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) {
pr_debug("%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)
pr_debug("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);
}
if (strncmp(opt, "primary_basic_test:", 19) == 0) {
unsigned int layer_num, w, h, fmt, frame_num,
vsync_num, x, y, r, g, b, a;
ret = sscanf(
opt,
"primary_basic_test:%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d\n",
&layer_num, &w, &h, &fmt, &frame_num, &vsync_num, &x,
&y, &r, &g, &b, &a);
if (ret != 12) {
pr_debug("error to parse cmd %s, ret=%d\n", opt, ret);
return;
}
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, w, h, fmt, frame_num,
vsync_num, x, y, r, g, b, a);
}
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) {
pr_debug("%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) {
pr_debug("%d error to parse cmd %s\n", __LINE__, opt);
return;
}
primary_display_set_scenario(scen);
}
}
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);
}
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,
};
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);
}
#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;
}
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
}
Reference in a new issue Copy permalink