// SPDX-License-Identifier: GPL-2.0
/*
* Imagination E5010 JPEG Encoder driver.
*
* Copyright (C) 2023 Texas Instruments Incorporated - https://www.ti.com/
*
* Author: David Huang <[email protected]>
* Author: Devarsh Thakkar <[email protected]>
*/
#include <linux/io.h>
#include <linux/iopoll.h>
#include <linux/dev_printk.h>
#include "e5010-jpeg-enc-hw.h"
static void write_reg_field(void __iomem *base, unsigned int offset, u32 mask,
unsigned int shift, u32 value)
{
u32 reg;
value <<= shift;
if (mask != 0xffffffff) {
reg = readl(base + offset);
value = (value & mask) | (reg & ~mask);
}
writel(value, (base + offset));
}
static int write_reg_field_not_busy(void __iomem *jasper_base, void __iomem *wr_base,
unsigned int offset, u32 mask, unsigned int shift,
u32 value)
{
int ret;
u32 val;
ret = readl_poll_timeout_atomic(jasper_base + JASPER_STATUS_OFFSET, val,
(val & JASPER_STATUS_CR_JASPER_BUSY_MASK) == 0,
2000, 50000);
if (ret)
return ret;
write_reg_field(wr_base, offset, mask, shift, value);
return 0;
}
void e5010_reset(struct device *dev, void __iomem *core_base, void __iomem *mmu_base)
{
int ret = 0;
u32 val;
write_reg_field(core_base, JASPER_RESET_OFFSET,
JASPER_RESET_CR_CORE_RESET_MASK,
JASPER_RESET_CR_CORE_RESET_SHIFT, 1);
write_reg_field(mmu_base, MMU_MMU_CONTROL1_OFFSET,
MMU_MMU_CONTROL1_MMU_SOFT_RESET_MASK,
MMU_MMU_CONTROL1_MMU_SOFT_RESET_SHIFT, 1);
ret = readl_poll_timeout_atomic(mmu_base + MMU_MMU_CONTROL1_OFFSET, val,
(val & MMU_MMU_CONTROL1_MMU_SOFT_RESET_MASK) == 0,
2000, 50000);
if (ret)
dev_warn(dev, "MMU soft reset timed out, forcing system soft reset\n");
write_reg_field(core_base, JASPER_RESET_OFFSET,
JASPER_RESET_CR_SYS_RESET_MASK,
JASPER_RESET_CR_SYS_RESET_SHIFT, 1);
}
void e5010_hw_bypass_mmu(void __iomem *mmu_base, u32 enable)
{
/* Bypass MMU */
write_reg_field(mmu_base,
MMU_MMU_ADDRESS_CONTROL_OFFSET,
MMU_MMU_ADDRESS_CONTROL_MMU_BYPASS_MASK,
MMU_MMU_ADDRESS_CONTROL_MMU_BYPASS_SHIFT,
enable);
}
int e5010_hw_enable_output_address_error_irq(void __iomem *core_base, u32 enable)
{
return write_reg_field_not_busy(core_base, core_base,
JASPER_INTERRUPT_MASK_OFFSET,
JASPER_INTERRUPT_MASK_CR_OUTPUT_ADDRESS_ERROR_ENABLE_MASK,
JASPER_INTERRUPT_MASK_CR_OUTPUT_ADDRESS_ERROR_ENABLE_SHIFT,
enable);
}
bool e5010_hw_pic_done_irq(void __iomem *core_base)
{
u32 reg;
reg = readl(core_base + JASPER_INTERRUPT_STATUS_OFFSET);
return reg & JASPER_INTERRUPT_STATUS_CR_PICTURE_DONE_IRQ_MASK;
}
bool e5010_hw_output_address_irq(void __iomem *core_base)
{
u32 reg;
reg = readl(core_base + JASPER_INTERRUPT_STATUS_OFFSET);
return reg & JASPER_INTERRUPT_STATUS_CR_OUTPUT_ADDRESS_ERROR_IRQ_MASK;
}
int e5010_hw_enable_picture_done_irq(void __iomem *core_base, u32 enable)
{
return write_reg_field_not_busy(core_base, core_base,
JASPER_INTERRUPT_MASK_OFFSET,
JASPER_INTERRUPT_MASK_CR_PICTURE_DONE_ENABLE_MASK,
JASPER_INTERRUPT_MASK_CR_PICTURE_DONE_ENABLE_SHIFT,
enable);
}
int e5010_hw_enable_auto_clock_gating(void __iomem *core_base, u32 enable)
{
return write_reg_field_not_busy(core_base, core_base,
JASPER_CLK_CONTROL_OFFSET,
JASPER_CLK_CONTROL_CR_JASPER_AUTO_CLKG_ENABLE_MASK,
JASPER_CLK_CONTROL_CR_JASPER_AUTO_CLKG_ENABLE_SHIFT,
enable);
}
int e5010_hw_enable_manual_clock_gating(void __iomem *core_base, u32 enable)
{
return write_reg_field_not_busy(core_base, core_base,
JASPER_CLK_CONTROL_OFFSET,
JASPER_CLK_CONTROL_CR_JASPER_MAN_CLKG_ENABLE_MASK,
JASPER_CLK_CONTROL_CR_JASPER_MAN_CLKG_ENABLE_SHIFT, 0);
}
int e5010_hw_enable_crc_check(void __iomem *core_base, u32 enable)
{
return write_reg_field_not_busy(core_base, core_base,
JASPER_CRC_CTRL_OFFSET,
JASPER_CRC_CTRL_JASPER_CRC_ENABLE_MASK,
JASPER_CRC_CTRL_JASPER_CRC_ENABLE_SHIFT, enable);
}
int e5010_hw_set_input_source_to_memory(void __iomem *core_base, u32 set)
{
return write_reg_field_not_busy(core_base, core_base,
JASPER_INPUT_CTRL0_OFFSET,
JASPER_INPUT_CTRL0_CR_INPUT_SOURCE_MASK,
JASPER_INPUT_CTRL0_CR_INPUT_SOURCE_SHIFT, set);
}
int e5010_hw_set_input_luma_addr(void __iomem *core_base, u32 val)
{
return write_reg_field_not_busy(core_base, core_base,
INPUT_LUMA_BASE_OFFSET,
INPUT_LUMA_BASE_CR_INPUT_LUMA_BASE_MASK, 0, val);
}
int e5010_hw_set_input_chroma_addr(void __iomem *core_base, u32 val)
{
return write_reg_field_not_busy(core_base, core_base,
INPUT_CHROMA_BASE_OFFSET,
INPUT_CHROMA_BASE_CR_INPUT_CHROMA_BASE_MASK, 0, val);
}
int e5010_hw_set_output_base_addr(void __iomem *core_base, u32 val)
{
return write_reg_field_not_busy(core_base, core_base,
JASPER_OUTPUT_BASE_OFFSET,
JASPER_OUTPUT_BASE_CR_OUTPUT_BASE_MASK,
JASPER_OUTPUT_BASE_CR_OUTPUT_BASE_SHIFT, val);
}
int e5010_hw_set_horizontal_size(void __iomem *core_base, u32 val)
{
return write_reg_field_not_busy(core_base, core_base,
JASPER_IMAGE_SIZE_OFFSET,
JASPER_IMAGE_SIZE_CR_IMAGE_HORIZONTAL_SIZE_MASK,
JASPER_IMAGE_SIZE_CR_IMAGE_HORIZONTAL_SIZE_SHIFT,
val);
}
int e5010_hw_set_vertical_size(void __iomem *core_base, u32 val)
{
return write_reg_field_not_busy(core_base, core_base,
JASPER_IMAGE_SIZE_OFFSET,
JASPER_IMAGE_SIZE_CR_IMAGE_VERTICAL_SIZE_MASK,
JASPER_IMAGE_SIZE_CR_IMAGE_VERTICAL_SIZE_SHIFT,
val);
}
int e5010_hw_set_luma_stride(void __iomem *core_base, u32 bytesperline)
{
u32 val = bytesperline / 64;
return write_reg_field_not_busy(core_base, core_base,
JASPER_INPUT_CTRL1_OFFSET,
JASPER_INPUT_CTRL1_CR_INPUT_LUMA_STRIDE_MASK,
JASPER_INPUT_CTRL1_CR_INPUT_LUMA_STRIDE_SHIFT,
val);
}
int e5010_hw_set_chroma_stride(void __iomem *core_base, u32 bytesperline)
{
u32 val = bytesperline / 64;
return write_reg_field_not_busy(core_base, core_base,
JASPER_INPUT_CTRL1_OFFSET,
JASPER_INPUT_CTRL1_CR_INPUT_CHROMA_STRIDE_MASK,
JASPER_INPUT_CTRL1_CR_INPUT_CHROMA_STRIDE_SHIFT,
val);
}
int e5010_hw_set_input_subsampling(void __iomem *core_base, u32 val)
{
return write_reg_field_not_busy(core_base, core_base,
JASPER_INPUT_CTRL0_OFFSET,
JASPER_INPUT_CTRL0_CR_INPUT_SUBSAMPLING_MASK,
JASPER_INPUT_CTRL0_CR_INPUT_SUBSAMPLING_SHIFT,
val);
}
int e5010_hw_set_chroma_order(void __iomem *core_base, u32 val)
{
return write_reg_field_not_busy(core_base, core_base,
JASPER_INPUT_CTRL0_OFFSET,
JASPER_INPUT_CTRL0_CR_INPUT_CHROMA_ORDER_MASK,
JASPER_INPUT_CTRL0_CR_INPUT_CHROMA_ORDER_SHIFT,
val);
}
void e5010_hw_set_output_max_size(void __iomem *core_base, u32 val)
{
write_reg_field(core_base, JASPER_OUTPUT_MAX_SIZE_OFFSET,
JASPER_OUTPUT_MAX_SIZE_CR_OUTPUT_MAX_SIZE_MASK,
JASPER_OUTPUT_MAX_SIZE_CR_OUTPUT_MAX_SIZE_SHIFT,
val);
}
int e5010_hw_set_qpvalue(void __iomem *core_base, u32 offset, u32 val)
{
return write_reg_field_not_busy(core_base, core_base, offset, 0xffffffff, 0, val);
}
void e5010_hw_clear_output_error(void __iomem *core_base, u32 clear)
{
/* Make sure interrupts are clear */
write_reg_field(core_base, JASPER_INTERRUPT_CLEAR_OFFSET,
JASPER_INTERRUPT_CLEAR_CR_OUTPUT_ERROR_CLEAR_MASK,
JASPER_INTERRUPT_CLEAR_CR_OUTPUT_ERROR_CLEAR_SHIFT, clear);
}
void e5010_hw_clear_picture_done(void __iomem *core_base, u32 clear)
{
write_reg_field(core_base,
JASPER_INTERRUPT_CLEAR_OFFSET,
JASPER_INTERRUPT_CLEAR_CR_PICTURE_DONE_CLEAR_MASK,
JASPER_INTERRUPT_CLEAR_CR_PICTURE_DONE_CLEAR_SHIFT, clear);
}
int e5010_hw_get_output_size(void __iomem *core_base)
{
return readl(core_base + JASPER_OUTPUT_SIZE_OFFSET);
}
void e5010_hw_encode_start(void __iomem *core_base, u32 start)
{
write_reg_field(core_base, JASPER_CORE_CTRL_OFFSET,
JASPER_CORE_CTRL_CR_JASPER_ENCODE_START_MASK,
JASPER_CORE_CTRL_CR_JASPER_ENCODE_START_SHIFT, start);
}