244 lines
7.3 KiB
C
244 lines
7.3 KiB
C
|
// SPDX-License-Identifier: (GPL-2.0+ OR MIT)
|
||
|
|
/*
|
||
|
|
* Rockchip ISP1 Driver - Base driver
|
||
|
|
*
|
||
|
|
* Copyright (C) 2019 Collabora, Ltd.
|
||
|
|
*
|
||
|
|
* Based on Rockchip ISP1 driver by Rockchip Electronics Co., Ltd.
|
||
|
|
* Copyright (C) 2017 Rockchip Electronics Co., Ltd.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <linux/debugfs.h>
|
||
|
|
#include <linux/delay.h>
|
||
|
|
#include <linux/device.h>
|
||
|
|
#include <linux/minmax.h>
|
||
|
|
#include <linux/pm_runtime.h>
|
||
|
|
#include <linux/seq_file.h>
|
||
|
|
#include <linux/string.h>
|
||
|
|
|
||
|
|
#include "rkisp1-common.h"
|
||
|
|
#include "rkisp1-regs.h"
|
||
|
|
|
||
|
|
struct rkisp1_debug_register {
|
||
|
|
u32 reg;
|
||
|
|
u32 shd;
|
||
|
|
const char * const name;
|
||
|
|
};
|
||
|
|
|
||
|
|
#define RKISP1_DEBUG_REG(name) { RKISP1_CIF_##name, 0, #name }
|
||
|
|
#define RKISP1_DEBUG_SHD_REG(name) { \
|
||
|
|
RKISP1_CIF_##name, RKISP1_CIF_##name##_SHD, #name \
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Keep this up-to-date when adding new registers. */
|
||
|
|
#define RKISP1_MAX_REG_LENGTH 21
|
||
|
|
|
||
|
|
static int rkisp1_debug_dump_regs(struct rkisp1_device *rkisp1,
|
||
|
|
struct seq_file *m, unsigned int offset,
|
||
|
|
const struct rkisp1_debug_register *regs)
|
||
|
|
{
|
||
|
|
const int width = RKISP1_MAX_REG_LENGTH;
|
||
|
|
u32 val, shd;
|
||
|
|
int ret;
|
||
|
|
|
||
|
|
ret = pm_runtime_get_if_in_use(rkisp1->dev);
|
||
|
|
if (ret <= 0)
|
||
|
|
return ret ? : -ENODATA;
|
||
|
|
|
||
|
|
for (; regs->name; ++regs) {
|
||
|
|
val = rkisp1_read(rkisp1, offset + regs->reg);
|
||
|
|
|
||
|
|
if (regs->shd) {
|
||
|
|
shd = rkisp1_read(rkisp1, offset + regs->shd);
|
||
|
|
seq_printf(m, "%*s: 0x%08x/0x%08x\n", width, regs->name,
|
||
|
|
val, shd);
|
||
|
|
} else {
|
||
|
|
seq_printf(m, "%*s: 0x%08x\n", width, regs->name, val);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
pm_runtime_put(rkisp1->dev);
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int rkisp1_debug_dump_core_regs_show(struct seq_file *m, void *p)
|
||
|
|
{
|
||
|
|
static const struct rkisp1_debug_register registers[] = {
|
||
|
|
RKISP1_DEBUG_REG(VI_CCL),
|
||
|
|
RKISP1_DEBUG_REG(VI_ICCL),
|
||
|
|
RKISP1_DEBUG_REG(VI_IRCL),
|
||
|
|
RKISP1_DEBUG_REG(VI_DPCL),
|
||
|
|
RKISP1_DEBUG_REG(MI_CTRL),
|
||
|
|
RKISP1_DEBUG_REG(MI_BYTE_CNT),
|
||
|
|
RKISP1_DEBUG_REG(MI_CTRL_SHD),
|
||
|
|
RKISP1_DEBUG_REG(MI_RIS),
|
||
|
|
RKISP1_DEBUG_REG(MI_STATUS),
|
||
|
|
RKISP1_DEBUG_REG(MI_DMA_CTRL),
|
||
|
|
RKISP1_DEBUG_REG(MI_DMA_STATUS),
|
||
|
|
{ /* Sentinel */ },
|
||
|
|
};
|
||
|
|
struct rkisp1_device *rkisp1 = m->private;
|
||
|
|
|
||
|
|
return rkisp1_debug_dump_regs(rkisp1, m, 0, registers);
|
||
|
|
}
|
||
|
|
DEFINE_SHOW_ATTRIBUTE(rkisp1_debug_dump_core_regs);
|
||
|
|
|
||
|
|
static int rkisp1_debug_dump_isp_regs_show(struct seq_file *m, void *p)
|
||
|
|
{
|
||
|
|
static const struct rkisp1_debug_register registers[] = {
|
||
|
|
RKISP1_DEBUG_REG(ISP_CTRL),
|
||
|
|
RKISP1_DEBUG_REG(ISP_ACQ_PROP),
|
||
|
|
RKISP1_DEBUG_REG(ISP_FLAGS_SHD),
|
||
|
|
RKISP1_DEBUG_REG(ISP_RIS),
|
||
|
|
RKISP1_DEBUG_REG(ISP_ERR),
|
||
|
|
{ /* Sentinel */ },
|
||
|
|
};
|
||
|
|
struct rkisp1_device *rkisp1 = m->private;
|
||
|
|
|
||
|
|
return rkisp1_debug_dump_regs(rkisp1, m, 0, registers);
|
||
|
|
}
|
||
|
|
DEFINE_SHOW_ATTRIBUTE(rkisp1_debug_dump_isp_regs);
|
||
|
|
|
||
|
|
static int rkisp1_debug_dump_rsz_regs_show(struct seq_file *m, void *p)
|
||
|
|
{
|
||
|
|
static const struct rkisp1_debug_register registers[] = {
|
||
|
|
RKISP1_DEBUG_SHD_REG(RSZ_CTRL),
|
||
|
|
RKISP1_DEBUG_SHD_REG(RSZ_SCALE_HY),
|
||
|
|
RKISP1_DEBUG_SHD_REG(RSZ_SCALE_HCB),
|
||
|
|
RKISP1_DEBUG_SHD_REG(RSZ_SCALE_HCR),
|
||
|
|
RKISP1_DEBUG_SHD_REG(RSZ_SCALE_VY),
|
||
|
|
RKISP1_DEBUG_SHD_REG(RSZ_SCALE_VC),
|
||
|
|
RKISP1_DEBUG_SHD_REG(RSZ_PHASE_HY),
|
||
|
|
RKISP1_DEBUG_SHD_REG(RSZ_PHASE_HC),
|
||
|
|
RKISP1_DEBUG_SHD_REG(RSZ_PHASE_VY),
|
||
|
|
RKISP1_DEBUG_SHD_REG(RSZ_PHASE_VC),
|
||
|
|
{ /* Sentinel */ },
|
||
|
|
};
|
||
|
|
struct rkisp1_resizer *rsz = m->private;
|
||
|
|
|
||
|
|
return rkisp1_debug_dump_regs(rsz->rkisp1, m, rsz->regs_base, registers);
|
||
|
|
}
|
||
|
|
DEFINE_SHOW_ATTRIBUTE(rkisp1_debug_dump_rsz_regs);
|
||
|
|
|
||
|
|
static int rkisp1_debug_dump_mi_mp_show(struct seq_file *m, void *p)
|
||
|
|
{
|
||
|
|
static const struct rkisp1_debug_register registers[] = {
|
||
|
|
RKISP1_DEBUG_REG(MI_MP_Y_BASE_AD_INIT),
|
||
|
|
RKISP1_DEBUG_REG(MI_MP_Y_BASE_AD_INIT2),
|
||
|
|
RKISP1_DEBUG_REG(MI_MP_Y_BASE_AD_SHD),
|
||
|
|
RKISP1_DEBUG_REG(MI_MP_Y_SIZE_INIT),
|
||
|
|
RKISP1_DEBUG_REG(MI_MP_Y_SIZE_INIT),
|
||
|
|
RKISP1_DEBUG_REG(MI_MP_Y_SIZE_SHD),
|
||
|
|
RKISP1_DEBUG_REG(MI_MP_Y_OFFS_CNT_SHD),
|
||
|
|
{ /* Sentinel */ },
|
||
|
|
};
|
||
|
|
struct rkisp1_device *rkisp1 = m->private;
|
||
|
|
|
||
|
|
return rkisp1_debug_dump_regs(rkisp1, m, 0, registers);
|
||
|
|
}
|
||
|
|
DEFINE_SHOW_ATTRIBUTE(rkisp1_debug_dump_mi_mp);
|
||
|
|
|
||
|
|
#define RKISP1_DEBUG_DATA_COUNT_BINS 32
|
||
|
|
#define RKISP1_DEBUG_DATA_COUNT_STEP (4096 / RKISP1_DEBUG_DATA_COUNT_BINS)
|
||
|
|
|
||
|
|
static int rkisp1_debug_input_status_show(struct seq_file *m, void *p)
|
||
|
|
{
|
||
|
|
struct rkisp1_device *rkisp1 = m->private;
|
||
|
|
u16 data_count[RKISP1_DEBUG_DATA_COUNT_BINS] = { };
|
||
|
|
unsigned int hsync_count = 0;
|
||
|
|
unsigned int vsync_count = 0;
|
||
|
|
unsigned int i;
|
||
|
|
u32 data;
|
||
|
|
u32 val;
|
||
|
|
int ret;
|
||
|
|
|
||
|
|
ret = pm_runtime_get_if_in_use(rkisp1->dev);
|
||
|
|
if (ret <= 0)
|
||
|
|
return ret ? : -ENODATA;
|
||
|
|
|
||
|
|
/* Sample the ISP input port status 10000 times with a 1µs interval. */
|
||
|
|
for (i = 0; i < 10000; ++i) {
|
||
|
|
val = rkisp1_read(rkisp1, RKISP1_CIF_ISP_FLAGS_SHD);
|
||
|
|
|
||
|
|
data = (val & RKISP1_CIF_ISP_FLAGS_SHD_S_DATA_MASK)
|
||
|
|
>> RKISP1_CIF_ISP_FLAGS_SHD_S_DATA_SHIFT;
|
||
|
|
data_count[data / RKISP1_DEBUG_DATA_COUNT_STEP]++;
|
||
|
|
|
||
|
|
if (val & RKISP1_CIF_ISP_FLAGS_SHD_S_HSYNC)
|
||
|
|
hsync_count++;
|
||
|
|
if (val & RKISP1_CIF_ISP_FLAGS_SHD_S_VSYNC)
|
||
|
|
vsync_count++;
|
||
|
|
|
||
|
|
udelay(1);
|
||
|
|
}
|
||
|
|
|
||
|
|
pm_runtime_put(rkisp1->dev);
|
||
|
|
|
||
|
|
seq_printf(m, "vsync: %u, hsync: %u\n", vsync_count, hsync_count);
|
||
|
|
seq_puts(m, "data:\n");
|
||
|
|
for (i = 0; i < ARRAY_SIZE(data_count); ++i)
|
||
|
|
seq_printf(m, "- [%04u:%04u]: %u\n",
|
||
|
|
i * RKISP1_DEBUG_DATA_COUNT_STEP,
|
||
|
|
(i + 1) * RKISP1_DEBUG_DATA_COUNT_STEP - 1,
|
||
|
|
data_count[i]);
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
DEFINE_SHOW_ATTRIBUTE(rkisp1_debug_input_status);
|
||
|
|
|
||
|
|
void rkisp1_debug_init(struct rkisp1_device *rkisp1)
|
||
|
|
{
|
||
|
|
struct rkisp1_debug *debug = &rkisp1->debug;
|
||
|
|
struct dentry *regs_dir;
|
||
|
|
|
||
|
|
debug->debugfs_dir = debugfs_create_dir(dev_name(rkisp1->dev), NULL);
|
||
|
|
|
||
|
|
debugfs_create_ulong("data_loss", 0444, debug->debugfs_dir,
|
||
|
|
&debug->data_loss);
|
||
|
|
debugfs_create_ulong("outform_size_err", 0444, debug->debugfs_dir,
|
||
|
|
&debug->outform_size_error);
|
||
|
|
debugfs_create_ulong("img_stabilization_size_error", 0444,
|
||
|
|
debug->debugfs_dir,
|
||
|
|
&debug->img_stabilization_size_error);
|
||
|
|
debugfs_create_ulong("inform_size_error", 0444, debug->debugfs_dir,
|
||
|
|
&debug->inform_size_error);
|
||
|
|
debugfs_create_ulong("irq_delay", 0444, debug->debugfs_dir,
|
||
|
|
&debug->irq_delay);
|
||
|
|
debugfs_create_ulong("mipi_error", 0444, debug->debugfs_dir,
|
||
|
|
&debug->mipi_error);
|
||
|
|
debugfs_create_ulong("stats_error", 0444, debug->debugfs_dir,
|
||
|
|
&debug->stats_error);
|
||
|
|
debugfs_create_ulong("mp_stop_timeout", 0444, debug->debugfs_dir,
|
||
|
|
&debug->stop_timeout[RKISP1_MAINPATH]);
|
||
|
|
debugfs_create_ulong("sp_stop_timeout", 0444, debug->debugfs_dir,
|
||
|
|
&debug->stop_timeout[RKISP1_SELFPATH]);
|
||
|
|
debugfs_create_ulong("mp_frame_drop", 0444, debug->debugfs_dir,
|
||
|
|
&debug->frame_drop[RKISP1_MAINPATH]);
|
||
|
|
debugfs_create_ulong("sp_frame_drop", 0444, debug->debugfs_dir,
|
||
|
|
&debug->frame_drop[RKISP1_SELFPATH]);
|
||
|
|
debugfs_create_file("input_status", 0444, debug->debugfs_dir, rkisp1,
|
||
|
|
&rkisp1_debug_input_status_fops);
|
||
|
|
|
||
|
|
regs_dir = debugfs_create_dir("regs", debug->debugfs_dir);
|
||
|
|
|
||
|
|
debugfs_create_file("core", 0444, regs_dir, rkisp1,
|
||
|
|
&rkisp1_debug_dump_core_regs_fops);
|
||
|
|
debugfs_create_file("isp", 0444, regs_dir, rkisp1,
|
||
|
|
&rkisp1_debug_dump_isp_regs_fops);
|
||
|
|
debugfs_create_file("mrsz", 0444, regs_dir,
|
||
|
|
&rkisp1->resizer_devs[RKISP1_MAINPATH],
|
||
|
|
&rkisp1_debug_dump_rsz_regs_fops);
|
||
|
|
debugfs_create_file("srsz", 0444, regs_dir,
|
||
|
|
&rkisp1->resizer_devs[RKISP1_SELFPATH],
|
||
|
|
&rkisp1_debug_dump_rsz_regs_fops);
|
||
|
|
|
||
|
|
debugfs_create_file("mi_mp", 0444, regs_dir, rkisp1,
|
||
|
|
&rkisp1_debug_dump_mi_mp_fops);
|
||
|
|
}
|
||
|
|
|
||
|
|
void rkisp1_debug_cleanup(struct rkisp1_device *rkisp1)
|
||
|
|
{
|
||
|
|
debugfs_remove_recursive(rkisp1->debug.debugfs_dir);
|
||
|
|
}
|