// SPDX-License-Identifier: GPL-2.0
/*
 * Rockchip Camera Interface (CIF) Driver
 *
 * Copyright (C) 2018 Rockchip Electronics Co., Ltd.
 * Copyright (C) 2020 Maxime Chevallier <maxime.chevallier@bootlin.com>
 * Copyright (C) 2023 Mehdi Djait <mehdi.djait@bootlin.com>
 * Copyright (C) 2025 Michael Riesch <michael.riesch@wolfvision.net>
 * Copyright (C) 2025 Collabora, Ltd.
 */

#include <media/v4l2-common.h>
#include <media/v4l2-fwnode.h>
#include <media/v4l2-mc.h>
#include <media/v4l2-subdev.h>

#include "rkcif-capture-dvp.h"
#include "rkcif-common.h"
#include "rkcif-interface.h"
#include "rkcif-regs.h"
#include "rkcif-stream.h"

static const struct rkcif_output_fmt dvp_out_fmts[] = {
        {
                .fourcc = V4L2_PIX_FMT_NV16,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_OUTPUT_422 |
                               RKCIF_FORMAT_UV_STORAGE_ORDER_UVUV,
                .cplanes = 2,
        },
        {
                .fourcc = V4L2_PIX_FMT_NV16M,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_OUTPUT_422 |
                               RKCIF_FORMAT_UV_STORAGE_ORDER_UVUV,
                .cplanes = 2,
        },
        {
                .fourcc = V4L2_PIX_FMT_NV61,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_OUTPUT_422 |
                               RKCIF_FORMAT_UV_STORAGE_ORDER_VUVU,
                .cplanes = 2,
        },
        {
                .fourcc = V4L2_PIX_FMT_NV61M,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_OUTPUT_422 |
                               RKCIF_FORMAT_UV_STORAGE_ORDER_VUVU,
                .cplanes = 2,
        },
        {
                .fourcc = V4L2_PIX_FMT_NV12,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_OUTPUT_420 |
                               RKCIF_FORMAT_UV_STORAGE_ORDER_UVUV,
                .cplanes = 2,
        },
        {
                .fourcc = V4L2_PIX_FMT_NV12M,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_OUTPUT_420 |
                               RKCIF_FORMAT_UV_STORAGE_ORDER_UVUV,
                .cplanes = 2,
        },
        {
                .fourcc = V4L2_PIX_FMT_NV21,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_OUTPUT_420 |
                               RKCIF_FORMAT_UV_STORAGE_ORDER_VUVU,
                .cplanes = 2,
        },
        {
                .fourcc = V4L2_PIX_FMT_NV21M,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_OUTPUT_420 |
                               RKCIF_FORMAT_UV_STORAGE_ORDER_VUVU,
                .cplanes = 2,
        },
        {
                .fourcc = V4L2_PIX_FMT_RGB24,
                .cplanes = 1,
        },
        {
                .fourcc = V4L2_PIX_FMT_RGB565,
                .cplanes = 1,
        },
        {
                .fourcc = V4L2_PIX_FMT_BGR666,
                .cplanes = 1,
        },
        {
                .fourcc = V4L2_PIX_FMT_SRGGB8,
                .cplanes = 1,
        },
        {
                .fourcc = V4L2_PIX_FMT_SGRBG8,
                .cplanes = 1,
        },
        {
                .fourcc = V4L2_PIX_FMT_SGBRG8,
                .cplanes = 1,
        },
        {
                .fourcc = V4L2_PIX_FMT_SBGGR8,
                .cplanes = 1,
        },
        {
                .fourcc = V4L2_PIX_FMT_SRGGB10,
                .cplanes = 1,
        },
        {
                .fourcc = V4L2_PIX_FMT_SGRBG10,
                .cplanes = 1,
        },
        {
                .fourcc = V4L2_PIX_FMT_SGBRG10,
                .cplanes = 1,
        },
        {
                .fourcc = V4L2_PIX_FMT_SBGGR10,
                .cplanes = 1,
        },
        {
                .fourcc = V4L2_PIX_FMT_SRGGB12,
                .cplanes = 1,
        },
        {
                .fourcc = V4L2_PIX_FMT_SGRBG12,
                .cplanes = 1,
        },
        {
                .fourcc = V4L2_PIX_FMT_SGBRG12,
                .cplanes = 1,
        },
        {
                .fourcc = V4L2_PIX_FMT_SBGGR12,
                .cplanes = 1,
        },
        {
                .fourcc = V4L2_PIX_FMT_SBGGR16,
                .cplanes = 1,
        },
        {
                .fourcc = V4L2_PIX_FMT_Y16,
                .cplanes = 1,
        },
};

static const struct rkcif_input_fmt px30_dvp_in_fmts[] = {
        {
                .mbus_code = MEDIA_BUS_FMT_YUYV8_2X8,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_INPUT_422 |
                               RKCIF_FORMAT_YUV_INPUT_ORDER_YUYV,
                .fmt_type = RKCIF_FMT_TYPE_YUV,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_YUYV8_2X8,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_INPUT_422 |
                               RKCIF_FORMAT_YUV_INPUT_ORDER_YUYV,
                .fmt_type = RKCIF_FMT_TYPE_YUV,
                .field = V4L2_FIELD_INTERLACED,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_YVYU8_2X8,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_INPUT_422 |
                               RKCIF_FORMAT_YUV_INPUT_ORDER_YVYU,
                .fmt_type = RKCIF_FMT_TYPE_YUV,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_YVYU8_2X8,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_INPUT_422 |
                               RKCIF_FORMAT_YUV_INPUT_ORDER_YVYU,
                .fmt_type = RKCIF_FMT_TYPE_YUV,
                .field = V4L2_FIELD_INTERLACED,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_UYVY8_2X8,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_INPUT_422 |
                               RKCIF_FORMAT_YUV_INPUT_ORDER_UYVY,
                .fmt_type = RKCIF_FMT_TYPE_YUV,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_UYVY8_2X8,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_INPUT_422 |
                               RKCIF_FORMAT_YUV_INPUT_ORDER_UYVY,
                .fmt_type = RKCIF_FMT_TYPE_YUV,
                .field = V4L2_FIELD_INTERLACED,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_VYUY8_2X8,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_INPUT_422 |
                               RKCIF_FORMAT_YUV_INPUT_ORDER_VYUY,
                .fmt_type = RKCIF_FMT_TYPE_YUV,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_VYUY8_2X8,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_INPUT_422 |
                               RKCIF_FORMAT_YUV_INPUT_ORDER_VYUY,
                .fmt_type = RKCIF_FMT_TYPE_YUV,
                .field = V4L2_FIELD_INTERLACED,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_SBGGR8_1X8,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_8,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_SGBRG8_1X8,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_8,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_SGRBG8_1X8,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_8,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_SRGGB8_1X8,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_8,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_SBGGR10_1X10,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_10,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_SGBRG10_1X10,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_10,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_SGRBG10_1X10,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_10,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_SRGGB10_1X10,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_10,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_SBGGR12_1X12,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_12,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_SGBRG12_1X12,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_12,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_SGRBG12_1X12,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_12,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_SRGGB12_1X12,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_12,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_RGB888_1X24,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_Y8_1X8,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_8,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_Y10_1X10,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_10,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_Y12_1X12,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_12,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        }
};

const struct rkcif_dvp_match_data rkcif_px30_vip_dvp_match_data = {
        .in_fmts = px30_dvp_in_fmts,
        .in_fmts_num = ARRAY_SIZE(px30_dvp_in_fmts),
        .out_fmts = dvp_out_fmts,
        .out_fmts_num = ARRAY_SIZE(dvp_out_fmts),
        .has_scaler = true,
        .regs = {
                [RKCIF_DVP_CTRL] = 0x00,
                [RKCIF_DVP_INTEN] = 0x04,
                [RKCIF_DVP_INTSTAT] = 0x08,
                [RKCIF_DVP_FOR] = 0x0c,
                [RKCIF_DVP_LINE_NUM_ADDR] = 0x10,
                [RKCIF_DVP_FRM0_ADDR_Y] = 0x14,
                [RKCIF_DVP_FRM0_ADDR_UV] = 0x18,
                [RKCIF_DVP_FRM1_ADDR_Y] = 0x1c,
                [RKCIF_DVP_FRM1_ADDR_UV] = 0x20,
                [RKCIF_DVP_VIR_LINE_WIDTH] = 0x24,
                [RKCIF_DVP_SET_SIZE] = 0x28,
                [RKCIF_DVP_SCL_CTRL] = 0x48,
                [RKCIF_DVP_FRAME_STATUS] = 0x60,
                [RKCIF_DVP_LAST_LINE] = 0x68,
                [RKCIF_DVP_LAST_PIX] = 0x6c,
        },
};

static const struct rkcif_input_fmt rk3568_dvp_in_fmts[] = {
        {
                .mbus_code = MEDIA_BUS_FMT_YUYV8_2X8,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_INPUT_422 |
                               RKCIF_FORMAT_YUV_INPUT_ORDER_YUYV,
                .fmt_type = RKCIF_FMT_TYPE_YUV,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_YUYV8_2X8,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_INPUT_422 |
                               RKCIF_FORMAT_YUV_INPUT_ORDER_YUYV,
                .fmt_type = RKCIF_FMT_TYPE_YUV,
                .field = V4L2_FIELD_INTERLACED,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_YVYU8_2X8,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_INPUT_422 |
                               RKCIF_FORMAT_YUV_INPUT_ORDER_YVYU,
                .fmt_type = RKCIF_FMT_TYPE_YUV,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_YVYU8_2X8,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_INPUT_422 |
                               RKCIF_FORMAT_YUV_INPUT_ORDER_YVYU,
                .fmt_type = RKCIF_FMT_TYPE_YUV,
                .field = V4L2_FIELD_INTERLACED,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_UYVY8_2X8,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_INPUT_422 |
                               RKCIF_FORMAT_YUV_INPUT_ORDER_UYVY,
                .fmt_type = RKCIF_FMT_TYPE_YUV,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_UYVY8_2X8,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_INPUT_422 |
                               RKCIF_FORMAT_YUV_INPUT_ORDER_UYVY,
                .fmt_type = RKCIF_FMT_TYPE_YUV,
                .field = V4L2_FIELD_INTERLACED,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_VYUY8_2X8,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_INPUT_422 |
                               RKCIF_FORMAT_YUV_INPUT_ORDER_VYUY,
                .fmt_type = RKCIF_FMT_TYPE_YUV,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_VYUY8_2X8,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_INPUT_422 |
                               RKCIF_FORMAT_YUV_INPUT_ORDER_VYUY,
                .fmt_type = RKCIF_FMT_TYPE_YUV,
                .field = V4L2_FIELD_INTERLACED,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_YUYV8_1X16,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_INPUT_422 |
                               RKCIF_FORMAT_YUV_INPUT_ORDER_YUYV |
                               RKCIF_FORMAT_INPUT_MODE_BT1120 |
                               RKCIF_FORMAT_BT1120_TRANSMIT_PROGRESS,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_YUYV8_1X16,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_INPUT_422 |
                               RKCIF_FORMAT_YUV_INPUT_ORDER_YUYV |
                               RKCIF_FORMAT_INPUT_MODE_BT1120,
                .field = V4L2_FIELD_INTERLACED,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_YVYU8_1X16,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_INPUT_422 |
                               RKCIF_FORMAT_YUV_INPUT_ORDER_YVYU |
                               RKCIF_FORMAT_INPUT_MODE_BT1120 |
                               RKCIF_FORMAT_BT1120_TRANSMIT_PROGRESS,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_YVYU8_1X16,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_INPUT_422 |
                               RKCIF_FORMAT_YUV_INPUT_ORDER_YVYU |
                               RKCIF_FORMAT_INPUT_MODE_BT1120,
                .field = V4L2_FIELD_INTERLACED,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_UYVY8_1X16,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_INPUT_422 |
                               RKCIF_FORMAT_YUV_INPUT_ORDER_YUYV |
                               RKCIF_FORMAT_INPUT_MODE_BT1120 |
                               RKCIF_FORMAT_BT1120_YC_SWAP |
                               RKCIF_FORMAT_BT1120_TRANSMIT_PROGRESS,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_UYVY8_1X16,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_INPUT_422 |
                               RKCIF_FORMAT_YUV_INPUT_ORDER_YUYV |
                               RKCIF_FORMAT_BT1120_YC_SWAP |
                               RKCIF_FORMAT_INPUT_MODE_BT1120,
                .field = V4L2_FIELD_INTERLACED,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_VYUY8_1X16,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_INPUT_422 |
                               RKCIF_FORMAT_YUV_INPUT_ORDER_YVYU |
                               RKCIF_FORMAT_INPUT_MODE_BT1120 |
                               RKCIF_FORMAT_BT1120_YC_SWAP |
                               RKCIF_FORMAT_BT1120_TRANSMIT_PROGRESS,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_VYUY8_1X16,
                .dvp_fmt_val = RKCIF_FORMAT_YUV_INPUT_422 |
                               RKCIF_FORMAT_YUV_INPUT_ORDER_YVYU |
                               RKCIF_FORMAT_BT1120_YC_SWAP |
                               RKCIF_FORMAT_INPUT_MODE_BT1120,
                .field = V4L2_FIELD_INTERLACED,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_SBGGR8_1X8,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_8,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_SGBRG8_1X8,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_8,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_SGRBG8_1X8,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_8,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_SRGGB8_1X8,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_8,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_SBGGR10_1X10,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_10,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_SGBRG10_1X10,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_10,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_SGRBG10_1X10,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_10,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_SRGGB10_1X10,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_10,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_SBGGR12_1X12,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_12,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_SGBRG12_1X12,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_12,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_SGRBG12_1X12,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_12,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_SRGGB12_1X12,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_12,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_RGB888_1X24,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_Y8_1X8,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_8,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_Y10_1X10,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_10,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
        {
                .mbus_code = MEDIA_BUS_FMT_Y12_1X12,
                .dvp_fmt_val = RKCIF_FORMAT_INPUT_MODE_RAW |
                               RKCIF_FORMAT_RAW_DATA_WIDTH_12,
                .fmt_type = RKCIF_FMT_TYPE_RAW,
                .field = V4L2_FIELD_NONE,
        },
};

static void rk3568_dvp_grf_setup(struct rkcif_device *rkcif)
{
        u32 con1 = RK3568_GRF_WRITE_ENABLE(RK3568_GRF_VI_CON1_CIF_DATAPATH |
                                           RK3568_GRF_VI_CON1_CIF_CLK_DELAYNUM);

        if (!rkcif->grf)
                return;

        con1 |= rkcif->interfaces[RKCIF_DVP].dvp.dvp_clk_delay &
                RK3568_GRF_VI_CON1_CIF_CLK_DELAYNUM;

        if (rkcif->interfaces[RKCIF_DVP].vep.bus.parallel.flags &
            V4L2_MBUS_PCLK_SAMPLE_DUALEDGE)
                con1 |= RK3568_GRF_VI_CON1_CIF_DATAPATH;

        regmap_write(rkcif->grf, RK3568_GRF_VI_CON1, con1);
}

const struct rkcif_dvp_match_data rkcif_rk3568_vicap_dvp_match_data = {
        .in_fmts = rk3568_dvp_in_fmts,
        .in_fmts_num = ARRAY_SIZE(rk3568_dvp_in_fmts),
        .out_fmts = dvp_out_fmts,
        .out_fmts_num = ARRAY_SIZE(dvp_out_fmts),
        .setup = rk3568_dvp_grf_setup,
        .has_scaler = false,
        .regs = {
                [RKCIF_DVP_CTRL] = 0x00,
                [RKCIF_DVP_INTEN] = 0x04,
                [RKCIF_DVP_INTSTAT] = 0x08,
                [RKCIF_DVP_FOR] = 0x0c,
                [RKCIF_DVP_LINE_NUM_ADDR] = 0x2c,
                [RKCIF_DVP_FRM0_ADDR_Y] = 0x14,
                [RKCIF_DVP_FRM0_ADDR_UV] = 0x18,
                [RKCIF_DVP_FRM1_ADDR_Y] = 0x1c,
                [RKCIF_DVP_FRM1_ADDR_UV] = 0x20,
                [RKCIF_DVP_VIR_LINE_WIDTH] = 0x24,
                [RKCIF_DVP_SET_SIZE] = 0x28,
                [RKCIF_DVP_CROP] = 0x34,
                [RKCIF_DVP_FRAME_STATUS] = 0x3c,
                [RKCIF_DVP_LAST_LINE] = 0x44,
                [RKCIF_DVP_LAST_PIX] = 0x48,
        },
};

static inline unsigned int rkcif_dvp_get_addr(struct rkcif_device *rkcif,
                                              unsigned int index)
{
        if (WARN_ON_ONCE(index >= RKCIF_DVP_REGISTER_MAX))
                return RKCIF_REGISTER_NOTSUPPORTED;

        return rkcif->match_data->dvp->regs[index];
}

static inline __maybe_unused void rkcif_dvp_write(struct rkcif_device *rkcif,
                                                  unsigned int index, u32 val)
{
        unsigned int addr = rkcif_dvp_get_addr(rkcif, index);

        if (addr == RKCIF_REGISTER_NOTSUPPORTED)
                return;

        writel(val, rkcif->base_addr + addr);
}

static inline __maybe_unused u32 rkcif_dvp_read(struct rkcif_device *rkcif,
                                                unsigned int index)
{
        unsigned int addr = rkcif_dvp_get_addr(rkcif, index);

        if (addr == RKCIF_REGISTER_NOTSUPPORTED)
                return 0;

        return readl(rkcif->base_addr + addr);
}

static void rkcif_dvp_queue_buffer(struct rkcif_stream *stream,
                                   unsigned int index)
{
        struct rkcif_device *rkcif = stream->rkcif;
        struct rkcif_buffer *buffer = stream->buffers[index];
        u32 frm_addr_y, frm_addr_uv;

        frm_addr_y = index ? RKCIF_DVP_FRM1_ADDR_Y : RKCIF_DVP_FRM0_ADDR_Y;
        frm_addr_uv = index ? RKCIF_DVP_FRM1_ADDR_UV : RKCIF_DVP_FRM0_ADDR_UV;

        rkcif_dvp_write(rkcif, frm_addr_y, buffer->buff_addr[RKCIF_PLANE_Y]);
        rkcif_dvp_write(rkcif, frm_addr_uv, buffer->buff_addr[RKCIF_PLANE_UV]);
}

static int rkcif_dvp_start_streaming(struct rkcif_stream *stream)
{
        struct rkcif_device *rkcif = stream->rkcif;
        struct rkcif_interface *interface = stream->interface;
        struct v4l2_mbus_config_parallel *parallel;
        struct v4l2_mbus_framefmt *source_fmt;
        struct v4l2_subdev_state *state;
        const struct rkcif_input_fmt *active_in_fmt;
        const struct rkcif_output_fmt *active_out_fmt;
        u32 val = 0;
        int ret = -EINVAL;

        state = v4l2_subdev_lock_and_get_active_state(&interface->sd);
        source_fmt = v4l2_subdev_state_get_format(state, RKCIF_IF_PAD_SRC,
                                                  stream->id);
        if (!source_fmt)
                goto out;

        active_in_fmt = rkcif_interface_find_input_fmt(interface, false,
                                                       source_fmt->code);
        active_out_fmt = rkcif_stream_find_output_fmt(stream, false,
                                                      stream->pix.pixelformat);
        if (!active_in_fmt || !active_out_fmt)
                goto out;

        parallel = &interface->vep.bus.parallel;
        if (parallel->bus_width == 16 &&
            (parallel->flags & V4L2_MBUS_PCLK_SAMPLE_DUALEDGE))
                val |= RKCIF_FORMAT_BT1120_CLOCK_DOUBLE_EDGES;
        val |= active_in_fmt->dvp_fmt_val;
        val |= active_out_fmt->dvp_fmt_val;
        rkcif_dvp_write(rkcif, RKCIF_DVP_FOR, val);

        val = stream->pix.width;
        if (active_in_fmt->fmt_type == RKCIF_FMT_TYPE_RAW)
                val = stream->pix.width * 2;
        rkcif_dvp_write(rkcif, RKCIF_DVP_VIR_LINE_WIDTH, val);

        val = RKCIF_XY_COORD(stream->pix.width, stream->pix.height);
        rkcif_dvp_write(rkcif, RKCIF_DVP_SET_SIZE, val);

        rkcif_dvp_write(rkcif, RKCIF_DVP_FRAME_STATUS, RKCIF_FRAME_STAT_CLS);
        rkcif_dvp_write(rkcif, RKCIF_DVP_INTSTAT, RKCIF_INTSTAT_CLS);
        if (rkcif->match_data->dvp->has_scaler) {
                val = active_in_fmt->fmt_type == RKCIF_FMT_TYPE_YUV ?
                              RKCIF_SCL_CTRL_ENABLE_YUV_16BIT_BYPASS :
                              RKCIF_SCL_CTRL_ENABLE_RAW_16BIT_BYPASS;
                rkcif_dvp_write(rkcif, RKCIF_DVP_SCL_CTRL, val);
        }

        rkcif_dvp_write(rkcif, RKCIF_DVP_INTEN,
                        RKCIF_INTEN_FRAME_END_EN |
                        RKCIF_INTEN_PST_INF_FRAME_END_EN);

        rkcif_dvp_write(rkcif, RKCIF_DVP_CTRL,
                        RKCIF_CTRL_AXI_BURST_16 | RKCIF_CTRL_MODE_PINGPONG |
                        RKCIF_CTRL_ENABLE_CAPTURE);

        ret = 0;

out:
        v4l2_subdev_unlock_state(state);
        return ret;
}

static void rkcif_dvp_stop_streaming(struct rkcif_stream *stream)
{
        struct rkcif_device *rkcif = stream->rkcif;
        u32 val;

        val = rkcif_dvp_read(rkcif, RKCIF_DVP_CTRL);
        rkcif_dvp_write(rkcif, RKCIF_DVP_CTRL,
                        val & (~RKCIF_CTRL_ENABLE_CAPTURE));
        rkcif_dvp_write(rkcif, RKCIF_DVP_INTEN, 0x0);
        rkcif_dvp_write(rkcif, RKCIF_DVP_INTSTAT, 0x3ff);
        rkcif_dvp_write(rkcif, RKCIF_DVP_FRAME_STATUS, 0x0);

        stream->stopping = false;
}

static void rkcif_dvp_reset_stream(struct rkcif_device *rkcif)
{
        u32 ctl = rkcif_dvp_read(rkcif, RKCIF_DVP_CTRL);

        rkcif_dvp_write(rkcif, RKCIF_DVP_CTRL,
                        ctl & (~RKCIF_CTRL_ENABLE_CAPTURE));
        rkcif_dvp_write(rkcif, RKCIF_DVP_CTRL, ctl | RKCIF_CTRL_ENABLE_CAPTURE);
}

static void rkcif_dvp_set_crop(struct rkcif_stream *stream, u16 left, u16 top)
{
        struct rkcif_device *rkcif = stream->rkcif;
        u32 val;

        val = RKCIF_XY_COORD(left, top);
        rkcif_dvp_write(rkcif, RKCIF_DVP_CROP, val);
}

irqreturn_t rkcif_dvp_isr(int irq, void *ctx)
{
        struct device *dev = ctx;
        struct rkcif_device *rkcif = dev_get_drvdata(dev);
        struct rkcif_stream *stream;
        u32 intstat, lastline, lastpix, cif_frmst;
        irqreturn_t ret = IRQ_NONE;

        if (!rkcif->match_data->dvp)
                return ret;

        intstat = rkcif_dvp_read(rkcif, RKCIF_DVP_INTSTAT);
        cif_frmst = rkcif_dvp_read(rkcif, RKCIF_DVP_FRAME_STATUS);
        lastline = RKCIF_FETCH_Y(rkcif_dvp_read(rkcif, RKCIF_DVP_LAST_LINE));
        lastpix = RKCIF_FETCH_Y(rkcif_dvp_read(rkcif, RKCIF_DVP_LAST_PIX));

        if (intstat & RKCIF_INTSTAT_FRAME_END) {
                rkcif_dvp_write(rkcif, RKCIF_DVP_INTSTAT,
                                RKCIF_INTSTAT_FRAME_END_CLR |
                                RKCIF_INTSTAT_LINE_END_CLR);

                stream = &rkcif->interfaces[RKCIF_DVP].streams[RKCIF_ID0];

                if (stream->stopping) {
                        rkcif_dvp_stop_streaming(stream);
                        wake_up(&stream->wq_stopped);
                        ret = IRQ_HANDLED;
                        goto out;
                }

                if (lastline != stream->pix.height) {
                        v4l2_err(&rkcif->v4l2_dev,
                                 "bad frame, irq:%#x frmst:%#x size:%dx%d\n",
                                 intstat, cif_frmst, lastpix, lastline);

                        rkcif_dvp_reset_stream(rkcif);
                }

                rkcif_stream_pingpong(stream);

                ret = IRQ_HANDLED;
        }
out:
        return ret;
}

int rkcif_dvp_register(struct rkcif_device *rkcif)
{
        struct rkcif_interface *interface;
        unsigned int streams_num;
        int ret;

        if (!rkcif->match_data->dvp)
                return 0;

        interface = &rkcif->interfaces[RKCIF_DVP];
        interface->index = RKCIF_DVP;
        interface->type = RKCIF_IF_DVP;
        interface->in_fmts = rkcif->match_data->dvp->in_fmts;
        interface->in_fmts_num = rkcif->match_data->dvp->in_fmts_num;
        interface->set_crop = rkcif_dvp_set_crop;
        ret = rkcif_interface_register(rkcif, interface);
        if (ret)
                return ret;

        if (rkcif->match_data->dvp->setup)
                rkcif->match_data->dvp->setup(rkcif);

        streams_num = rkcif->match_data->dvp->has_ids ? 4 : 1;
        for (unsigned int i = 0; i < streams_num; i++) {
                struct rkcif_stream *stream = &interface->streams[i];

                stream->id = i;
                stream->interface = interface;
                stream->out_fmts = rkcif->match_data->dvp->out_fmts;
                stream->out_fmts_num = rkcif->match_data->dvp->out_fmts_num;
                stream->queue_buffer = rkcif_dvp_queue_buffer;
                stream->start_streaming = rkcif_dvp_start_streaming;
                stream->stop_streaming = rkcif_dvp_stop_streaming;

                ret = rkcif_stream_register(rkcif, stream);
                if (ret)
                        goto err_streams_unregister;

                interface->streams_num++;
        }

        return 0;

err_streams_unregister:
        for (unsigned int i = 0; i < interface->streams_num; i++)
                rkcif_stream_unregister(&interface->streams[i]);

        rkcif_interface_unregister(interface);

        return ret;
}

void rkcif_dvp_unregister(struct rkcif_device *rkcif)
{
        struct rkcif_interface *interface;

        if (!rkcif->match_data->dvp)
                return;

        interface = &rkcif->interfaces[RKCIF_DVP];

        for (unsigned int i = 0; i < interface->streams_num; i++)
                rkcif_stream_unregister(&interface->streams[i]);

        rkcif_interface_unregister(interface);
}