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/mt6853/videox/debug.c
Fede2782 c05564c4d8
Import A346BXXU1AWB9 kernel source 
Android 13
2024-04-28 15:49:01 +02:00

1771 lines
47 KiB
C
Executable file
Raw Blame History

// 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>
#include <linux/debugfs.h>
#include <linux/wait.h>
#include <linux/time.h>
#include <linux/delay.h>
#include <linux/fs.h>
#include <linux/file.h>
#include <linux/sched.h>
#ifdef CONFIG_MTK_M4U
#include "m4u.h"
#endif
#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(CONFIG_MTK_IOMMU_V3)
#include "mtk_ion.h"
#include "ion_drv.h"
#include "ion.h"
#endif
#include "layering_rule.h"
#include "ddp_clkmgr.h"
static struct dentry *mtkfb_dbgfs;
unsigned int g_mobilelog = 1;
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(CONFIG_MTK_IOMMU_V3)
struct ion_client *client;
struct ion_mm_data mm_data;
struct ion_handle *handle;
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;
}
/* use get_iova replace config_buffer & get_phys*/
mm_data.config_buffer_param.kernel_handle = handle;
mm_data.mm_cmd = ION_MM_GET_IOVA;
if (ion_kernel_ioctl(client, ION_CMD_MULTIMEDIA,
(unsigned long)&mm_data) < 0) {
DISPWARN("ion_test_drv: get pa failed.\n");
ion_free(client, handle);
ion_client_destroy(client);
return -1;
}
buf_info->buf_mva = (unsigned int)mm_data.get_phys_param.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;
#ifdef CONFIG_MTK_M4U
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) {
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))
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);
}
buf_info->buf_mva = mva;
DISPMSG("%s MVA is 0x%x PA is 0x%pa\n",
__func__, mva, &buf_info->buf_pa);
return ret;
#else
struct ion_client *ion_display_client = NULL;
struct ion_handle *ion_display_handle = NULL;
unsigned long mva = 0;
size_align = round_up(size, PAGE_SIZE);
ion_display_client = disp_ion_create("disp_cap_ovl");
if (ion_display_client == NULL) {
DISPWARN("primary capture:Fail to create ion\n");
ret = -1;
goto out;
}
/*
* TODO: legacy ion_handle allocate API phase out,
* need develop another method allocate MVA
*/
if (ret != 0) {
DISPWARN("primary capture:Fail to allocate buffer\n");
ret = -1;
goto out;
}
disp_ion_get_mva(ion_display_client, ion_display_handle,
&mva, 0, DISP_M4U_PORT_DISP_WDMA0);
out:
buf_info->buf_mva = mva;
DISPMSG("%s MVA is 0x%lx PA is 0x%pa\n",
__func__, mva, &buf_info->buf_pa);
return ret;
#endif
}
static int release_test_buf(struct test_buf_info *buf_info)
{
#if defined(CONFIG_MTK_IOMMU_V3)
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);
}
#ifndef CONFIG_MTK_IOMMU_V3
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
#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;
}
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_ENG0_RD_ADDR,
rd_add);
DISP_REG_SET(NULL, DISP_REG_CONFIG_DISP_FAKE_ENG0_WR_ADDR,
wr_add);
DISP_REG_SET(NULL, DISP_REG_CONFIG_DISP_FAKE_ENG0_CON0,
(wr_pat<<24) | (loop<<22) | (length));
DISP_REG_SET(NULL, DISP_REG_CONFIG_DISP_FAKE_ENG0_CON1,
(brust<<12) | (disable_wr<<11) |
(disable_rd<<10) | (latency));
DISP_REG_SET(NULL, DISP_REG_CONFIG_DISP_FAKE_ENG0_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_ENG0_RD_ADDR));
DISPMSG("Fake eng start dump WD_ADDR = 0x%x\n",
DISP_REG_GET(DISP_REG_CONFIG_DISP_FAKE_ENG0_WR_ADDR));
DISPMSG("Fake eng start dump FAKE_CON0 = 0x%x\n",
DISP_REG_GET(DISP_REG_CONFIG_DISP_FAKE_ENG0_CON0));
DISPMSG("Fake eng start dump FAKE_CON1 = 0x%x\n",
DISP_REG_GET(DISP_REG_CONFIG_DISP_FAKE_ENG0_CON1));
DISPMSG("Fake eng start dump FAKE_EN = 0x%x\n",
DISP_REG_GET(DISP_REG_CONFIG_DISP_FAKE_ENG0_EN));
return 0;
}
static int disp_fake_engine_stop(void)
{
DISP_REG_SET(NULL, DISP_REG_CONFIG_DISP_FAKE_ENG0_EN, 1);
DISP_REG_SET(NULL, DISP_REG_CONFIG_DISP_FAKE_ENG0_RST, 1);
DISP_REG_SET(NULL, DISP_REG_CONFIG_DISP_FAKE_ENG0_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);
}
#if 0
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;
}
#endif
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);
} 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;
}
} 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(__func__, __LINE__);
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 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);
#if 0
} else if (strncmp(opt, "set_emi_bound_tb:", 17) == 0) {
do_set_emi_bound_tb_opt(opt);
#endif
} 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(__func__, __LINE__);
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(__func__, __LINE__);
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(__func__, __LINE__);
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_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);
}
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)
{
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);
}
}
void DBG_Deinit(void)
{
debugfs_remove(mtkfb_dbgfs);
}
Reference in a new issue View git blame Copy permalink