luban-lite-t3e-pro/bsp/artinchip/hal/dvp/hal_dvp.c

/*
 * Copyright (c) 2022-2024, ArtInChip Technology Co., Ltd
 *
 * SPDX-License-Identifier: Apache-2.0
 *
 * Authors: matteo <duanmt@artinchip.com>
 */

#include "aic_core.h"
#include "mpp_vin.h"

#include "hal_dvp.h"

static inline void dvp_writel(u32 val, int reg)
{
    writel(val, DVP_BASE + reg);
}

static inline u32 dvp_readl(int reg)
{
    return readl(DVP_BASE + reg);
}

static void hal_dvp_reg_enable(int offset, int bit, int enable)
{
    int tmp;

    tmp = dvp_readl(offset);
    tmp &= ~bit;
    if (enable)
        tmp |= bit;

    dvp_writel(tmp, offset);
}

void hal_dvp_enable(struct aic_dvp_config *cfg, int enable)
{
    if (!cfg->interlaced)
        hal_dvp_reg_enable(DVP_CTL, DVP_CTL_DROP_FRAME_EN, enable);

    hal_dvp_reg_enable(DVP_CTL, DVP_CTL_EN, enable);
}

void hal_dvp_capture_start(void)
{
    dvp_writel(DVP_OUT_CTL_CAP_ON, DVP_OUT_CTL);
}

void hal_dvp_capture_stop(void)
{
    dvp_writel(0, DVP_OUT_CTL);
}

void hal_dvp_clr_fifo(void)
{
    hal_dvp_reg_enable(DVP_CTL, DVP_CTL_CLR, 1);
}

int hal_dvp_clr_int(void)
{
    int sta = dvp_readl(DVP_IRQ_STA);

    dvp_writel(sta, DVP_IRQ_STA);
    return sta;
}

void hal_dvp_enable_int(struct aic_dvp_config *cfg, int enable)
{
    /* When HNUM IRQ happened, so we can update the address */
    if (enable)
        dvp_writel((cfg->height / 4) << DVP_IRQ_CFG_HNUM_SHIFT, DVP_IRQ_CFG);

    hal_dvp_reg_enable(DVP_IRQ_EN,
                       DVP_IRQ_EN_FRAME_DONE | DVP_IRQ_EN_HNUM, enable);
}

void hal_dvp_set_pol(u32 flags)
{
    u32 href_pol, pclk_pol, vref_pol, field_pol;

    field_pol = flags & MEDIA_SIGNAL_FIELD_ACTIVE_HIGH ?
                0 : DVP_IN_CFG_FILED_POL_ACTIVE_LOW;
    vref_pol = flags & MEDIA_SIGNAL_VSYNC_ACTIVE_LOW ?
                DVP_IN_CFG_VSYNC_POL_FALLING : 0;
    href_pol = flags & MEDIA_SIGNAL_HSYNC_ACTIVE_HIGH ?
                DVP_IN_CFG_HREF_POL_ACTIVE_HIGH : 0;
    pclk_pol = flags & MEDIA_SIGNAL_PCLK_SAMPLE_FALLING ?
                DVP_IN_CFG_PCLK_POL_FALLING : 0;
    dvp_writel(href_pol | vref_pol | pclk_pol | field_pol, DVP_IN_CFG);
}

void hal_dvp_set_cfg(struct aic_dvp_config *cfg)
{
    u32 height = 0, stride0 = 0, stride1 = 0, val = 0;

    if ((cfg->stride[0] == 0) || (cfg->stride[1] == 0)) {
        hal_log_err("Invalid stride: 0x%x 0x%x\n", cfg->stride[0], cfg->stride[1]);
        return;
    }

    if (cfg->interlaced) {
        height  = cfg->height / 2;
        stride0 = cfg->stride[0] * 2;
        stride1 = cfg->stride[1] * 2;
    } else {
        height  = cfg->height;
        stride0 = cfg->stride[0];
        stride1 = cfg->stride[1];
    }

    val = DVP_CTL_IN_FMT(cfg->input)
            | DVP_CTL_IN_SEQ(cfg->input_seq)
            | DVP_CTL_OUT_FMT(cfg->output)
            | DVP_CTL_EN;
    if (!cfg->interlaced)
        val |= DVP_CTL_DROP_FRAME_EN;
    dvp_writel(val, DVP_CTL);

    dvp_writel(DVP_OUT_HOR_NUM(cfg->width), DVP_OUT_HOR_SIZE);
    dvp_writel(DVP_OUT_VER_NUM(height), DVP_OUT_VER_SIZE);

    dvp_writel(stride0, DVP_OUT_LINE_STRIDE0);
    dvp_writel(stride1, DVP_OUT_LINE_STRIDE1);
}

void hal_dvp_update_buf_addr(dma_addr_t y, dma_addr_t uv, u32 offset)
{
    if ((y == 0) || (uv == 0)) {
        hal_log_err("Invalid DMA address: Y 0x%x, UV 0x%x\n", (u32)y, (u32)uv);
        return;
    }
    dvp_writel(y + offset, DVP_OUT_ADDR_BUF(0));
    dvp_writel(uv + offset, DVP_OUT_ADDR_BUF(1));
}

void hal_dvp_update_ctl(void)
{
    dvp_writel(1, DVP_OUT_UPDATE_CTL);
}

void hal_dvp_record_mode(void)
{
    dvp_writel(0x80000000, DVP_OUT_FRA_NUM);
}

void hal_dvp_qos_cfg(u32 high, u32 low, u32 inc_thd, u32 dec_thd)
{
    u32 val = DVP_QOS_CUSTOM;

    val |= (inc_thd << DVP_QOS_INC_THR_SHIFT) & DVP_QOS_INC_THR_MASK;
    val |= (dec_thd << DVP_QOS_DEC_THR_SHIFT) & DVP_QOS_DEC_THR_MASK;
    val |= (high << DVP_QOS_HIGH_SHIFT) & DVP_QOS_HIGH_MASK;
    val |= low & DVP_QOS_LOW_MASK;
    hal_log_info("DVP QoS is enable: 0x%x\n", val);
    dvp_writel(val, DVP_QOS_CFG);
}

static int g_top_field = 0;

u32 hal_dvp_get_current_xy(void)
{
    u32 val = dvp_readl(DVP_IN_HOR_SIZE);

    g_top_field = val & DVP_IN_HOR_SIZE_XY_CODE_F ? 0 : 1;
    hal_log_debug("XY: %#x, is %s\n",
                  (u32)(val & DVP_IN_HOR_SIZE_XY_CODE_MASK),
                  g_top_field ? "Top" : "Bottom");

    return g_top_field;
}

u32 hal_dvp_is_top_field(void)
{
    return g_top_field;
}

u32 hal_dvp_is_bottom_field(void)
{
    return !g_top_field;
}

void hal_dvp_field_tag_clr(void)
{
    g_top_field = 0;
}