Quelle  jpeg-hw-exynos4.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-only
/* Copyright (c) 2013 Samsung Electronics Co., Ltd.
 * http://www.samsung.com/
 *
 * Author: Jacek Anaszewski <j.anaszewski@samsung.com>
 *
 * Register interface file for JPEG driver on Exynos4x12.
 */
#include <linux/io.h>
#include <linux/delay.h>

#include "jpeg-core.h"
#include "jpeg-hw-exynos4.h"
#include "jpeg-regs.h"

void exynos4_jpeg_sw_reset(void __iomem *base)
{
 unsigned int reg;

 reg = readl(base + EXYNOS4_JPEG_CNTL_REG);
 writel(reg & ~(EXYNOS4_DEC_MODE | EXYNOS4_ENC_MODE),
    base + EXYNOS4_JPEG_CNTL_REG);

 reg = readl(base + EXYNOS4_JPEG_CNTL_REG);
 writel(reg & ~EXYNOS4_SOFT_RESET_HI, base + EXYNOS4_JPEG_CNTL_REG);

 udelay(100);

 writel(reg | EXYNOS4_SOFT_RESET_HI, base + EXYNOS4_JPEG_CNTL_REG);
}

void exynos4_jpeg_set_enc_dec_mode(void __iomem *base, unsigned int mode)
{
 unsigned int reg;

 reg = readl(base + EXYNOS4_JPEG_CNTL_REG);
 /* set exynos4_jpeg mod register */
 if (mode == S5P_JPEG_DECODE) {
  writel((reg & EXYNOS4_ENC_DEC_MODE_MASK) |
     EXYNOS4_DEC_MODE,
   base + EXYNOS4_JPEG_CNTL_REG);
 } else if (mode == S5P_JPEG_ENCODE) {/* encode */
  writel((reg & EXYNOS4_ENC_DEC_MODE_MASK) |
     EXYNOS4_ENC_MODE,
   base + EXYNOS4_JPEG_CNTL_REG);
 } else { /* disable both */
  writel(reg & EXYNOS4_ENC_DEC_MODE_MASK,
   base + EXYNOS4_JPEG_CNTL_REG);
 }
}

void __exynos4_jpeg_set_img_fmt(void __iomem *base, unsigned int img_fmt,
    unsigned int version)
{
 unsigned int reg;
 unsigned int exynos4_swap_chroma_cbcr;
 unsigned int exynos4_swap_chroma_crcb;

 if (version == SJPEG_EXYNOS4) {
  exynos4_swap_chroma_cbcr = EXYNOS4_SWAP_CHROMA_CBCR;
  exynos4_swap_chroma_crcb = EXYNOS4_SWAP_CHROMA_CRCB;
 } else {
  exynos4_swap_chroma_cbcr = EXYNOS5433_SWAP_CHROMA_CBCR;
  exynos4_swap_chroma_crcb = EXYNOS5433_SWAP_CHROMA_CRCB;
 }

 reg = readl(base + EXYNOS4_IMG_FMT_REG) &
   EXYNOS4_ENC_IN_FMT_MASK; /* clear except enc format */

 switch (img_fmt) {
 case V4L2_PIX_FMT_GREY:
  reg = reg | EXYNOS4_ENC_GRAY_IMG | EXYNOS4_GRAY_IMG_IP;
  break;
 case V4L2_PIX_FMT_RGB32:
  reg = reg | EXYNOS4_ENC_RGB_IMG |
    EXYNOS4_RGB_IP_RGB_32BIT_IMG;
  break;
 case V4L2_PIX_FMT_RGB565:
  reg = reg | EXYNOS4_ENC_RGB_IMG |
    EXYNOS4_RGB_IP_RGB_16BIT_IMG;
  break;
 case V4L2_PIX_FMT_NV24:
  reg = reg | EXYNOS4_ENC_YUV_444_IMG |
    EXYNOS4_YUV_444_IP_YUV_444_2P_IMG |
    exynos4_swap_chroma_cbcr;
  break;
 case V4L2_PIX_FMT_NV42:
  reg = reg | EXYNOS4_ENC_YUV_444_IMG |
    EXYNOS4_YUV_444_IP_YUV_444_2P_IMG |
    exynos4_swap_chroma_crcb;
  break;
 case V4L2_PIX_FMT_YUYV:
  reg = reg | EXYNOS4_DEC_YUV_422_IMG |
    EXYNOS4_YUV_422_IP_YUV_422_1P_IMG |
    exynos4_swap_chroma_cbcr;
  break;

 case V4L2_PIX_FMT_YVYU:
  reg = reg | EXYNOS4_DEC_YUV_422_IMG |
    EXYNOS4_YUV_422_IP_YUV_422_1P_IMG |
    exynos4_swap_chroma_crcb;
  break;
 case V4L2_PIX_FMT_NV16:
  reg = reg | EXYNOS4_DEC_YUV_422_IMG |
    EXYNOS4_YUV_422_IP_YUV_422_2P_IMG |
    exynos4_swap_chroma_cbcr;
  break;
 case V4L2_PIX_FMT_NV61:
  reg = reg | EXYNOS4_DEC_YUV_422_IMG |
    EXYNOS4_YUV_422_IP_YUV_422_2P_IMG |
    exynos4_swap_chroma_crcb;
  break;
 case V4L2_PIX_FMT_NV12:
  reg = reg | EXYNOS4_DEC_YUV_420_IMG |
    EXYNOS4_YUV_420_IP_YUV_420_2P_IMG |
    exynos4_swap_chroma_cbcr;
  break;
 case V4L2_PIX_FMT_NV21:
  reg = reg | EXYNOS4_DEC_YUV_420_IMG |
    EXYNOS4_YUV_420_IP_YUV_420_2P_IMG |
    exynos4_swap_chroma_crcb;
  break;
 case V4L2_PIX_FMT_YUV420:
  reg = reg | EXYNOS4_DEC_YUV_420_IMG |
    EXYNOS4_YUV_420_IP_YUV_420_3P_IMG |
    exynos4_swap_chroma_cbcr;
  break;
 default:
  break;

 }

 writel(reg, base + EXYNOS4_IMG_FMT_REG);
}

void __exynos4_jpeg_set_enc_out_fmt(void __iomem *base, unsigned int out_fmt,
        unsigned int version)
{
 unsigned int reg;

 reg = readl(base + EXYNOS4_IMG_FMT_REG) &
   ~(version == SJPEG_EXYNOS4 ? EXYNOS4_ENC_FMT_MASK :
     EXYNOS5433_ENC_FMT_MASK); /* clear enc format */

 switch (out_fmt) {
 case V4L2_JPEG_CHROMA_SUBSAMPLING_GRAY:
  reg = reg | EXYNOS4_ENC_FMT_GRAY;
  break;

 case V4L2_JPEG_CHROMA_SUBSAMPLING_444:
  reg = reg | EXYNOS4_ENC_FMT_YUV_444;
  break;

 case V4L2_JPEG_CHROMA_SUBSAMPLING_422:
  reg = reg | EXYNOS4_ENC_FMT_YUV_422;
  break;

 case V4L2_JPEG_CHROMA_SUBSAMPLING_420:
  reg = reg | EXYNOS4_ENC_FMT_YUV_420;
  break;

 default:
  break;
 }

 writel(reg, base + EXYNOS4_IMG_FMT_REG);
}

void exynos4_jpeg_set_interrupt(void __iomem *base, unsigned int version)
{
 unsigned int reg;

 if (version == SJPEG_EXYNOS4) {
  reg = readl(base + EXYNOS4_INT_EN_REG) & ~EXYNOS4_INT_EN_MASK;
  writel(reg | EXYNOS4_INT_EN_ALL, base + EXYNOS4_INT_EN_REG);
 } else {
  reg = readl(base + EXYNOS4_INT_EN_REG) &
       ~EXYNOS5433_INT_EN_MASK;
  writel(reg | EXYNOS5433_INT_EN_ALL, base + EXYNOS4_INT_EN_REG);
 }
}

unsigned int exynos4_jpeg_get_int_status(void __iomem *base)
{
 return readl(base + EXYNOS4_INT_STATUS_REG);
}

void exynos4_jpeg_set_huf_table_enable(void __iomem *base, int value)
{
 unsigned int reg;

 reg = readl(base + EXYNOS4_JPEG_CNTL_REG) & ~EXYNOS4_HUF_TBL_EN;

 if (value == 1)
  writel(reg | EXYNOS4_HUF_TBL_EN,
     base + EXYNOS4_JPEG_CNTL_REG);
 else
  writel(reg & ~EXYNOS4_HUF_TBL_EN,
     base + EXYNOS4_JPEG_CNTL_REG);
}

void exynos4_jpeg_set_sys_int_enable(void __iomem *base, int value)
{
 unsigned int reg;

 reg = readl(base + EXYNOS4_JPEG_CNTL_REG) & ~(EXYNOS4_SYS_INT_EN);

 if (value == 1)
  writel(reg | EXYNOS4_SYS_INT_EN, base + EXYNOS4_JPEG_CNTL_REG);
 else
  writel(reg & ~EXYNOS4_SYS_INT_EN, base + EXYNOS4_JPEG_CNTL_REG);
}

void exynos4_jpeg_set_stream_buf_address(void __iomem *base,
      unsigned int address)
{
 writel(address, base + EXYNOS4_OUT_MEM_BASE_REG);
}

void exynos4_jpeg_set_stream_size(void __iomem *base,
  unsigned int x_value, unsigned int y_value)
{
 writel(0x0, base + EXYNOS4_JPEG_IMG_SIZE_REG); /* clear */
 writel(EXYNOS4_X_SIZE(x_value) | EXYNOS4_Y_SIZE(y_value),
   base + EXYNOS4_JPEG_IMG_SIZE_REG);
}

void exynos4_jpeg_set_frame_buf_address(void __iomem *base,
    struct s5p_jpeg_addr *exynos4_jpeg_addr)
{
 writel(exynos4_jpeg_addr->y, base + EXYNOS4_IMG_BA_PLANE_1_REG);
 writel(exynos4_jpeg_addr->cb, base + EXYNOS4_IMG_BA_PLANE_2_REG);
 writel(exynos4_jpeg_addr->cr, base + EXYNOS4_IMG_BA_PLANE_3_REG);
}

void exynos4_jpeg_set_encode_tbl_select(void __iomem *base,
  enum exynos4_jpeg_img_quality_level level)
{
 unsigned int reg;

 reg = EXYNOS4_Q_TBL_COMP1_0 | EXYNOS4_Q_TBL_COMP2_1 |
  EXYNOS4_Q_TBL_COMP3_1 |
  EXYNOS4_HUFF_TBL_COMP1_AC_0_DC_1 |
  EXYNOS4_HUFF_TBL_COMP2_AC_0_DC_0 |
  EXYNOS4_HUFF_TBL_COMP3_AC_1_DC_1;

 writel(reg, base + EXYNOS4_TBL_SEL_REG);
}

void exynos4_jpeg_set_dec_components(void __iomem *base, int n)
{
 unsigned int reg;

 reg = readl(base + EXYNOS4_TBL_SEL_REG);

 reg |= EXYNOS4_NF(n);
 writel(reg, base + EXYNOS4_TBL_SEL_REG);
}

void exynos4_jpeg_select_dec_q_tbl(void __iomem *base, char c, char x)
{
 unsigned int reg;

 reg = readl(base + EXYNOS4_TBL_SEL_REG);

 reg |= EXYNOS4_Q_TBL_COMP(c, x);
 writel(reg, base + EXYNOS4_TBL_SEL_REG);
}

void exynos4_jpeg_select_dec_h_tbl(void __iomem *base, char c, char x)
{
 unsigned int reg;

 reg = readl(base + EXYNOS4_TBL_SEL_REG);

 reg |= EXYNOS4_HUFF_TBL_COMP(c, x);
 writel(reg, base + EXYNOS4_TBL_SEL_REG);
}

void exynos4_jpeg_set_encode_hoff_cnt(void __iomem *base, unsigned int fmt)
{
 if (fmt == V4L2_PIX_FMT_GREY)
  writel(0xd2, base + EXYNOS4_HUFF_CNT_REG);
 else
  writel(0x1a2, base + EXYNOS4_HUFF_CNT_REG);
}

unsigned int exynos4_jpeg_get_stream_size(void __iomem *base)
{
 return readl(base + EXYNOS4_BITSTREAM_SIZE_REG);
}

void exynos4_jpeg_set_dec_bitstream_size(void __iomem *base, unsigned int size)
{
 writel(size, base + EXYNOS4_BITSTREAM_SIZE_REG);
}

unsigned int exynos4_jpeg_get_frame_fmt(void __iomem *base)
{
 return readl(base + EXYNOS4_DECODE_IMG_FMT_REG) &
    EXYNOS4_JPEG_DECODED_IMG_FMT_MASK;
}