forked from Minki/linux
f7cbd688f0
The first while loop in the function exynos3250_jpeg_reset had no chance to be executed because the reg variable was initialized to 0. Initialize reg variable to 1 to fix the issue. Signed-off-by: Jacek Anaszewski <j.anaszewski@samsung.com> Reported-by: Andrzej Pietrasiewicz <andrzej.p@samsung.com> Signed-off-by: Sylwester Nawrocki <s.nawrocki@samsung.com> Signed-off-by: Mauro Carvalho Chehab <mchehab@osg.samsung.com>
490 lines
12 KiB
C
490 lines
12 KiB
C
/* linux/drivers/media/platform/exynos3250-jpeg/jpeg-hw.h
|
|
*
|
|
* Copyright (c) 2014 Samsung Electronics Co., Ltd.
|
|
* http://www.samsung.com
|
|
*
|
|
* Author: Jacek Anaszewski <j.anaszewski@samsung.com>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*/
|
|
|
|
#include <linux/io.h>
|
|
#include <linux/videodev2.h>
|
|
#include <linux/delay.h>
|
|
|
|
#include "jpeg-core.h"
|
|
#include "jpeg-regs.h"
|
|
#include "jpeg-hw-exynos3250.h"
|
|
|
|
void exynos3250_jpeg_reset(void __iomem *regs)
|
|
{
|
|
u32 reg = 1;
|
|
int count = 1000;
|
|
|
|
writel(1, regs + EXYNOS3250_SW_RESET);
|
|
/* no other way but polling for when JPEG IP becomes operational */
|
|
while (reg != 0 && --count > 0) {
|
|
udelay(1);
|
|
cpu_relax();
|
|
reg = readl(regs + EXYNOS3250_SW_RESET);
|
|
}
|
|
|
|
reg = 0;
|
|
count = 1000;
|
|
|
|
while (reg != 1 && --count > 0) {
|
|
writel(1, regs + EXYNOS3250_JPGDRI);
|
|
udelay(1);
|
|
cpu_relax();
|
|
reg = readl(regs + EXYNOS3250_JPGDRI);
|
|
}
|
|
|
|
writel(0, regs + EXYNOS3250_JPGDRI);
|
|
}
|
|
|
|
void exynos3250_jpeg_poweron(void __iomem *regs)
|
|
{
|
|
writel(EXYNOS3250_POWER_ON, regs + EXYNOS3250_JPGCLKCON);
|
|
}
|
|
|
|
void exynos3250_jpeg_set_dma_num(void __iomem *regs)
|
|
{
|
|
writel(((EXYNOS3250_DMA_MO_COUNT << EXYNOS3250_WDMA_ISSUE_NUM_SHIFT) &
|
|
EXYNOS3250_WDMA_ISSUE_NUM_MASK) |
|
|
((EXYNOS3250_DMA_MO_COUNT << EXYNOS3250_RDMA_ISSUE_NUM_SHIFT) &
|
|
EXYNOS3250_RDMA_ISSUE_NUM_MASK) |
|
|
((EXYNOS3250_DMA_MO_COUNT << EXYNOS3250_ISSUE_GATHER_NUM_SHIFT) &
|
|
EXYNOS3250_ISSUE_GATHER_NUM_MASK),
|
|
regs + EXYNOS3250_DMA_ISSUE_NUM);
|
|
}
|
|
|
|
void exynos3250_jpeg_clk_set(void __iomem *base)
|
|
{
|
|
u32 reg;
|
|
|
|
reg = readl(base + EXYNOS3250_JPGCMOD) & ~EXYNOS3250_HALF_EN_MASK;
|
|
|
|
writel(reg | EXYNOS3250_HALF_EN, base + EXYNOS3250_JPGCMOD);
|
|
}
|
|
|
|
void exynos3250_jpeg_input_raw_fmt(void __iomem *regs, unsigned int fmt)
|
|
{
|
|
u32 reg;
|
|
|
|
reg = readl(regs + EXYNOS3250_JPGCMOD) &
|
|
EXYNOS3250_MODE_Y16_MASK;
|
|
|
|
switch (fmt) {
|
|
case V4L2_PIX_FMT_RGB32:
|
|
reg |= EXYNOS3250_MODE_SEL_ARGB8888;
|
|
break;
|
|
case V4L2_PIX_FMT_BGR32:
|
|
reg |= EXYNOS3250_MODE_SEL_ARGB8888 | EXYNOS3250_SRC_SWAP_RGB;
|
|
break;
|
|
case V4L2_PIX_FMT_RGB565:
|
|
reg |= EXYNOS3250_MODE_SEL_RGB565;
|
|
break;
|
|
case V4L2_PIX_FMT_RGB565X:
|
|
reg |= EXYNOS3250_MODE_SEL_RGB565 | EXYNOS3250_SRC_SWAP_RGB;
|
|
break;
|
|
case V4L2_PIX_FMT_YUYV:
|
|
reg |= EXYNOS3250_MODE_SEL_422_1P_LUM_CHR;
|
|
break;
|
|
case V4L2_PIX_FMT_YVYU:
|
|
reg |= EXYNOS3250_MODE_SEL_422_1P_LUM_CHR |
|
|
EXYNOS3250_SRC_SWAP_UV;
|
|
break;
|
|
case V4L2_PIX_FMT_UYVY:
|
|
reg |= EXYNOS3250_MODE_SEL_422_1P_CHR_LUM;
|
|
break;
|
|
case V4L2_PIX_FMT_VYUY:
|
|
reg |= EXYNOS3250_MODE_SEL_422_1P_CHR_LUM |
|
|
EXYNOS3250_SRC_SWAP_UV;
|
|
break;
|
|
case V4L2_PIX_FMT_NV12:
|
|
reg |= EXYNOS3250_MODE_SEL_420_2P | EXYNOS3250_SRC_NV12;
|
|
break;
|
|
case V4L2_PIX_FMT_NV21:
|
|
reg |= EXYNOS3250_MODE_SEL_420_2P | EXYNOS3250_SRC_NV21;
|
|
break;
|
|
case V4L2_PIX_FMT_YUV420:
|
|
reg |= EXYNOS3250_MODE_SEL_420_3P;
|
|
break;
|
|
default:
|
|
break;
|
|
|
|
}
|
|
|
|
writel(reg, regs + EXYNOS3250_JPGCMOD);
|
|
}
|
|
|
|
void exynos3250_jpeg_set_y16(void __iomem *regs, bool y16)
|
|
{
|
|
u32 reg;
|
|
|
|
reg = readl(regs + EXYNOS3250_JPGCMOD);
|
|
if (y16)
|
|
reg |= EXYNOS3250_MODE_Y16;
|
|
else
|
|
reg &= ~EXYNOS3250_MODE_Y16_MASK;
|
|
writel(reg, regs + EXYNOS3250_JPGCMOD);
|
|
}
|
|
|
|
void exynos3250_jpeg_proc_mode(void __iomem *regs, unsigned int mode)
|
|
{
|
|
u32 reg, m;
|
|
|
|
if (mode == S5P_JPEG_ENCODE)
|
|
m = EXYNOS3250_PROC_MODE_COMPR;
|
|
else
|
|
m = EXYNOS3250_PROC_MODE_DECOMPR;
|
|
reg = readl(regs + EXYNOS3250_JPGMOD);
|
|
reg &= ~EXYNOS3250_PROC_MODE_MASK;
|
|
reg |= m;
|
|
writel(reg, regs + EXYNOS3250_JPGMOD);
|
|
}
|
|
|
|
void exynos3250_jpeg_subsampling_mode(void __iomem *regs, unsigned int mode)
|
|
{
|
|
u32 reg, m = 0;
|
|
|
|
switch (mode) {
|
|
case V4L2_JPEG_CHROMA_SUBSAMPLING_444:
|
|
m = EXYNOS3250_SUBSAMPLING_MODE_444;
|
|
break;
|
|
case V4L2_JPEG_CHROMA_SUBSAMPLING_422:
|
|
m = EXYNOS3250_SUBSAMPLING_MODE_422;
|
|
break;
|
|
case V4L2_JPEG_CHROMA_SUBSAMPLING_420:
|
|
m = EXYNOS3250_SUBSAMPLING_MODE_420;
|
|
break;
|
|
}
|
|
|
|
reg = readl(regs + EXYNOS3250_JPGMOD);
|
|
reg &= ~EXYNOS3250_SUBSAMPLING_MODE_MASK;
|
|
reg |= m;
|
|
writel(reg, regs + EXYNOS3250_JPGMOD);
|
|
}
|
|
|
|
unsigned int exynos3250_jpeg_get_subsampling_mode(void __iomem *regs)
|
|
{
|
|
return readl(regs + EXYNOS3250_JPGMOD) &
|
|
EXYNOS3250_SUBSAMPLING_MODE_MASK;
|
|
}
|
|
|
|
void exynos3250_jpeg_dri(void __iomem *regs, unsigned int dri)
|
|
{
|
|
u32 reg;
|
|
|
|
reg = dri & EXYNOS3250_JPGDRI_MASK;
|
|
writel(reg, regs + EXYNOS3250_JPGDRI);
|
|
}
|
|
|
|
void exynos3250_jpeg_qtbl(void __iomem *regs, unsigned int t, unsigned int n)
|
|
{
|
|
unsigned long reg;
|
|
|
|
reg = readl(regs + EXYNOS3250_QHTBL);
|
|
reg &= ~EXYNOS3250_QT_NUM_MASK(t);
|
|
reg |= (n << EXYNOS3250_QT_NUM_SHIFT(t)) &
|
|
EXYNOS3250_QT_NUM_MASK(t);
|
|
writel(reg, regs + EXYNOS3250_QHTBL);
|
|
}
|
|
|
|
void exynos3250_jpeg_htbl_ac(void __iomem *regs, unsigned int t)
|
|
{
|
|
unsigned long reg;
|
|
|
|
reg = readl(regs + EXYNOS3250_QHTBL);
|
|
reg &= ~EXYNOS3250_HT_NUM_AC_MASK(t);
|
|
/* this driver uses table 0 for all color components */
|
|
reg |= (0 << EXYNOS3250_HT_NUM_AC_SHIFT(t)) &
|
|
EXYNOS3250_HT_NUM_AC_MASK(t);
|
|
writel(reg, regs + EXYNOS3250_QHTBL);
|
|
}
|
|
|
|
void exynos3250_jpeg_htbl_dc(void __iomem *regs, unsigned int t)
|
|
{
|
|
unsigned long reg;
|
|
|
|
reg = readl(regs + EXYNOS3250_QHTBL);
|
|
reg &= ~EXYNOS3250_HT_NUM_DC_MASK(t);
|
|
/* this driver uses table 0 for all color components */
|
|
reg |= (0 << EXYNOS3250_HT_NUM_DC_SHIFT(t)) &
|
|
EXYNOS3250_HT_NUM_DC_MASK(t);
|
|
writel(reg, regs + EXYNOS3250_QHTBL);
|
|
}
|
|
|
|
void exynos3250_jpeg_set_y(void __iomem *regs, unsigned int y)
|
|
{
|
|
u32 reg;
|
|
|
|
reg = y & EXYNOS3250_JPGY_MASK;
|
|
writel(reg, regs + EXYNOS3250_JPGY);
|
|
}
|
|
|
|
void exynos3250_jpeg_set_x(void __iomem *regs, unsigned int x)
|
|
{
|
|
u32 reg;
|
|
|
|
reg = x & EXYNOS3250_JPGX_MASK;
|
|
writel(reg, regs + EXYNOS3250_JPGX);
|
|
}
|
|
|
|
#if 0 /* Currently unused */
|
|
unsigned int exynos3250_jpeg_get_y(void __iomem *regs)
|
|
{
|
|
return readl(regs + EXYNOS3250_JPGY);
|
|
}
|
|
|
|
unsigned int exynos3250_jpeg_get_x(void __iomem *regs)
|
|
{
|
|
return readl(regs + EXYNOS3250_JPGX);
|
|
}
|
|
#endif
|
|
|
|
void exynos3250_jpeg_interrupts_enable(void __iomem *regs)
|
|
{
|
|
u32 reg;
|
|
|
|
reg = readl(regs + EXYNOS3250_JPGINTSE);
|
|
reg |= (EXYNOS3250_JPEG_DONE_EN |
|
|
EXYNOS3250_WDMA_DONE_EN |
|
|
EXYNOS3250_RDMA_DONE_EN |
|
|
EXYNOS3250_ENC_STREAM_INT_EN |
|
|
EXYNOS3250_CORE_DONE_EN |
|
|
EXYNOS3250_ERR_INT_EN |
|
|
EXYNOS3250_HEAD_INT_EN);
|
|
writel(reg, regs + EXYNOS3250_JPGINTSE);
|
|
}
|
|
|
|
void exynos3250_jpeg_enc_stream_bound(void __iomem *regs, unsigned int size)
|
|
{
|
|
u32 reg;
|
|
|
|
reg = size & EXYNOS3250_ENC_STREAM_BOUND_MASK;
|
|
writel(reg, regs + EXYNOS3250_ENC_STREAM_BOUND);
|
|
}
|
|
|
|
void exynos3250_jpeg_output_raw_fmt(void __iomem *regs, unsigned int fmt)
|
|
{
|
|
u32 reg;
|
|
|
|
switch (fmt) {
|
|
case V4L2_PIX_FMT_RGB32:
|
|
reg = EXYNOS3250_OUT_FMT_ARGB8888;
|
|
break;
|
|
case V4L2_PIX_FMT_BGR32:
|
|
reg = EXYNOS3250_OUT_FMT_ARGB8888 | EXYNOS3250_OUT_SWAP_RGB;
|
|
break;
|
|
case V4L2_PIX_FMT_RGB565:
|
|
reg = EXYNOS3250_OUT_FMT_RGB565;
|
|
break;
|
|
case V4L2_PIX_FMT_RGB565X:
|
|
reg = EXYNOS3250_OUT_FMT_RGB565 | EXYNOS3250_OUT_SWAP_RGB;
|
|
break;
|
|
case V4L2_PIX_FMT_YUYV:
|
|
reg = EXYNOS3250_OUT_FMT_422_1P_LUM_CHR;
|
|
break;
|
|
case V4L2_PIX_FMT_YVYU:
|
|
reg = EXYNOS3250_OUT_FMT_422_1P_LUM_CHR |
|
|
EXYNOS3250_OUT_SWAP_UV;
|
|
break;
|
|
case V4L2_PIX_FMT_UYVY:
|
|
reg = EXYNOS3250_OUT_FMT_422_1P_CHR_LUM;
|
|
break;
|
|
case V4L2_PIX_FMT_VYUY:
|
|
reg = EXYNOS3250_OUT_FMT_422_1P_CHR_LUM |
|
|
EXYNOS3250_OUT_SWAP_UV;
|
|
break;
|
|
case V4L2_PIX_FMT_NV12:
|
|
reg = EXYNOS3250_OUT_FMT_420_2P | EXYNOS3250_OUT_NV12;
|
|
break;
|
|
case V4L2_PIX_FMT_NV21:
|
|
reg = EXYNOS3250_OUT_FMT_420_2P | EXYNOS3250_OUT_NV21;
|
|
break;
|
|
case V4L2_PIX_FMT_YUV420:
|
|
reg = EXYNOS3250_OUT_FMT_420_3P;
|
|
break;
|
|
default:
|
|
reg = 0;
|
|
break;
|
|
}
|
|
|
|
writel(reg, regs + EXYNOS3250_OUTFORM);
|
|
}
|
|
|
|
void exynos3250_jpeg_jpgadr(void __iomem *regs, unsigned int addr)
|
|
{
|
|
writel(addr, regs + EXYNOS3250_JPG_JPGADR);
|
|
}
|
|
|
|
void exynos3250_jpeg_imgadr(void __iomem *regs, struct s5p_jpeg_addr *img_addr)
|
|
{
|
|
writel(img_addr->y, regs + EXYNOS3250_LUMA_BASE);
|
|
writel(img_addr->cb, regs + EXYNOS3250_CHROMA_BASE);
|
|
writel(img_addr->cr, regs + EXYNOS3250_CHROMA_CR_BASE);
|
|
}
|
|
|
|
void exynos3250_jpeg_stride(void __iomem *regs, unsigned int img_fmt,
|
|
unsigned int width)
|
|
{
|
|
u32 reg_luma = 0, reg_cr = 0, reg_cb = 0;
|
|
|
|
switch (img_fmt) {
|
|
case V4L2_PIX_FMT_RGB32:
|
|
reg_luma = 4 * width;
|
|
break;
|
|
case V4L2_PIX_FMT_RGB565:
|
|
case V4L2_PIX_FMT_RGB565X:
|
|
case V4L2_PIX_FMT_YUYV:
|
|
case V4L2_PIX_FMT_YVYU:
|
|
case V4L2_PIX_FMT_UYVY:
|
|
case V4L2_PIX_FMT_VYUY:
|
|
reg_luma = 2 * width;
|
|
break;
|
|
case V4L2_PIX_FMT_NV12:
|
|
case V4L2_PIX_FMT_NV21:
|
|
reg_luma = width;
|
|
reg_cb = reg_luma;
|
|
break;
|
|
case V4L2_PIX_FMT_YUV420:
|
|
reg_luma = width;
|
|
reg_cb = reg_cr = reg_luma / 2;
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
writel(reg_luma, regs + EXYNOS3250_LUMA_STRIDE);
|
|
writel(reg_cb, regs + EXYNOS3250_CHROMA_STRIDE);
|
|
writel(reg_cr, regs + EXYNOS3250_CHROMA_CR_STRIDE);
|
|
}
|
|
|
|
void exynos3250_jpeg_offset(void __iomem *regs, unsigned int x_offset,
|
|
unsigned int y_offset)
|
|
{
|
|
u32 reg;
|
|
|
|
reg = (y_offset << EXYNOS3250_LUMA_YY_OFFSET_SHIFT) &
|
|
EXYNOS3250_LUMA_YY_OFFSET_MASK;
|
|
reg |= (x_offset << EXYNOS3250_LUMA_YX_OFFSET_SHIFT) &
|
|
EXYNOS3250_LUMA_YX_OFFSET_MASK;
|
|
|
|
writel(reg, regs + EXYNOS3250_LUMA_XY_OFFSET);
|
|
|
|
reg = (y_offset << EXYNOS3250_CHROMA_YY_OFFSET_SHIFT) &
|
|
EXYNOS3250_CHROMA_YY_OFFSET_MASK;
|
|
reg |= (x_offset << EXYNOS3250_CHROMA_YX_OFFSET_SHIFT) &
|
|
EXYNOS3250_CHROMA_YX_OFFSET_MASK;
|
|
|
|
writel(reg, regs + EXYNOS3250_CHROMA_XY_OFFSET);
|
|
|
|
reg = (y_offset << EXYNOS3250_CHROMA_CR_YY_OFFSET_SHIFT) &
|
|
EXYNOS3250_CHROMA_CR_YY_OFFSET_MASK;
|
|
reg |= (x_offset << EXYNOS3250_CHROMA_CR_YX_OFFSET_SHIFT) &
|
|
EXYNOS3250_CHROMA_CR_YX_OFFSET_MASK;
|
|
|
|
writel(reg, regs + EXYNOS3250_CHROMA_CR_XY_OFFSET);
|
|
}
|
|
|
|
void exynos3250_jpeg_coef(void __iomem *base, unsigned int mode)
|
|
{
|
|
if (mode == S5P_JPEG_ENCODE) {
|
|
writel(EXYNOS3250_JPEG_ENC_COEF1,
|
|
base + EXYNOS3250_JPG_COEF(1));
|
|
writel(EXYNOS3250_JPEG_ENC_COEF2,
|
|
base + EXYNOS3250_JPG_COEF(2));
|
|
writel(EXYNOS3250_JPEG_ENC_COEF3,
|
|
base + EXYNOS3250_JPG_COEF(3));
|
|
} else {
|
|
writel(EXYNOS3250_JPEG_DEC_COEF1,
|
|
base + EXYNOS3250_JPG_COEF(1));
|
|
writel(EXYNOS3250_JPEG_DEC_COEF2,
|
|
base + EXYNOS3250_JPG_COEF(2));
|
|
writel(EXYNOS3250_JPEG_DEC_COEF3,
|
|
base + EXYNOS3250_JPG_COEF(3));
|
|
}
|
|
}
|
|
|
|
void exynos3250_jpeg_start(void __iomem *regs)
|
|
{
|
|
writel(1, regs + EXYNOS3250_JSTART);
|
|
}
|
|
|
|
void exynos3250_jpeg_rstart(void __iomem *regs)
|
|
{
|
|
writel(1, regs + EXYNOS3250_JRSTART);
|
|
}
|
|
|
|
unsigned int exynos3250_jpeg_get_int_status(void __iomem *regs)
|
|
{
|
|
return readl(regs + EXYNOS3250_JPGINTST);
|
|
}
|
|
|
|
void exynos3250_jpeg_clear_int_status(void __iomem *regs,
|
|
unsigned int value)
|
|
{
|
|
return writel(value, regs + EXYNOS3250_JPGINTST);
|
|
}
|
|
|
|
unsigned int exynos3250_jpeg_operating(void __iomem *regs)
|
|
{
|
|
return readl(regs + S5P_JPGOPR) & EXYNOS3250_JPGOPR_MASK;
|
|
}
|
|
|
|
unsigned int exynos3250_jpeg_compressed_size(void __iomem *regs)
|
|
{
|
|
return readl(regs + EXYNOS3250_JPGCNT) & EXYNOS3250_JPGCNT_MASK;
|
|
}
|
|
|
|
void exynos3250_jpeg_dec_stream_size(void __iomem *regs,
|
|
unsigned int size)
|
|
{
|
|
writel(size & EXYNOS3250_DEC_STREAM_MASK,
|
|
regs + EXYNOS3250_DEC_STREAM_SIZE);
|
|
}
|
|
|
|
void exynos3250_jpeg_dec_scaling_ratio(void __iomem *regs,
|
|
unsigned int sratio)
|
|
{
|
|
switch (sratio) {
|
|
case 1:
|
|
default:
|
|
sratio = EXYNOS3250_DEC_SCALE_FACTOR_8_8;
|
|
break;
|
|
case 2:
|
|
sratio = EXYNOS3250_DEC_SCALE_FACTOR_4_8;
|
|
break;
|
|
case 4:
|
|
sratio = EXYNOS3250_DEC_SCALE_FACTOR_2_8;
|
|
break;
|
|
case 8:
|
|
sratio = EXYNOS3250_DEC_SCALE_FACTOR_1_8;
|
|
break;
|
|
}
|
|
|
|
writel(sratio & EXYNOS3250_DEC_SCALE_FACTOR_MASK,
|
|
regs + EXYNOS3250_DEC_SCALING_RATIO);
|
|
}
|
|
|
|
void exynos3250_jpeg_set_timer(void __iomem *regs, unsigned int time_value)
|
|
{
|
|
time_value &= EXYNOS3250_TIMER_INIT_MASK;
|
|
|
|
writel(EXYNOS3250_TIMER_INT_STAT | time_value,
|
|
regs + EXYNOS3250_TIMER_SE);
|
|
}
|
|
|
|
unsigned int exynos3250_jpeg_get_timer_status(void __iomem *regs)
|
|
{
|
|
return readl(regs + EXYNOS3250_TIMER_ST);
|
|
}
|
|
|
|
void exynos3250_jpeg_clear_timer_status(void __iomem *regs)
|
|
{
|
|
writel(EXYNOS3250_TIMER_INT_STAT, regs + EXYNOS3250_TIMER_ST);
|
|
}
|