mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-09-19 09:04:57 +00:00
237556962e
Exynos DRM drivers should work with and without IOMMU. Providing common API generic to both scenarios should make code cleaner and allow further code improvements. The patch removes including of exynos_drm_iommu.h as the file contains mostly IOMMU specific stuff, instead it exposes exynos_drm_*_dma functions and puts them into exynos_drm_dma.c. Signed-off-by: Andrzej Hajda <a.hajda@samsung.com> Signed-off-by: Inki Dae <inki.dae@samsung.com>
738 lines
20 KiB
C
738 lines
20 KiB
C
/*
|
|
* Copyright (C) 2017 Samsung Electronics Co.Ltd
|
|
* Author:
|
|
* Andrzej Pietrasiewicz <andrzej.p@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 Foundationr
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/component.h>
|
|
#include <linux/err.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/io.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/clk.h>
|
|
#include <linux/of_device.h>
|
|
#include <linux/pm_runtime.h>
|
|
|
|
#include <drm/drmP.h>
|
|
#include <drm/exynos_drm.h>
|
|
#include "regs-scaler.h"
|
|
#include "exynos_drm_fb.h"
|
|
#include "exynos_drm_drv.h"
|
|
#include "exynos_drm_ipp.h"
|
|
|
|
#define scaler_read(offset) readl(scaler->regs + (offset))
|
|
#define scaler_write(cfg, offset) writel(cfg, scaler->regs + (offset))
|
|
#define SCALER_MAX_CLK 4
|
|
#define SCALER_AUTOSUSPEND_DELAY 2000
|
|
#define SCALER_RESET_WAIT_RETRIES 100
|
|
|
|
struct scaler_data {
|
|
const char *clk_name[SCALER_MAX_CLK];
|
|
unsigned int num_clk;
|
|
const struct exynos_drm_ipp_formats *formats;
|
|
unsigned int num_formats;
|
|
};
|
|
|
|
struct scaler_context {
|
|
struct exynos_drm_ipp ipp;
|
|
struct drm_device *drm_dev;
|
|
struct device *dev;
|
|
void __iomem *regs;
|
|
struct clk *clock[SCALER_MAX_CLK];
|
|
struct exynos_drm_ipp_task *task;
|
|
const struct scaler_data *scaler_data;
|
|
};
|
|
|
|
struct scaler_format {
|
|
u32 drm_fmt;
|
|
u32 internal_fmt;
|
|
u32 chroma_tile_w;
|
|
u32 chroma_tile_h;
|
|
};
|
|
|
|
static const struct scaler_format scaler_formats[] = {
|
|
{ DRM_FORMAT_NV12, SCALER_YUV420_2P_UV, 8, 8 },
|
|
{ DRM_FORMAT_NV21, SCALER_YUV420_2P_VU, 8, 8 },
|
|
{ DRM_FORMAT_YUV420, SCALER_YUV420_3P, 8, 8 },
|
|
{ DRM_FORMAT_YUYV, SCALER_YUV422_1P_YUYV, 16, 16 },
|
|
{ DRM_FORMAT_UYVY, SCALER_YUV422_1P_UYVY, 16, 16 },
|
|
{ DRM_FORMAT_YVYU, SCALER_YUV422_1P_YVYU, 16, 16 },
|
|
{ DRM_FORMAT_NV16, SCALER_YUV422_2P_UV, 8, 16 },
|
|
{ DRM_FORMAT_NV61, SCALER_YUV422_2P_VU, 8, 16 },
|
|
{ DRM_FORMAT_YUV422, SCALER_YUV422_3P, 8, 16 },
|
|
{ DRM_FORMAT_NV24, SCALER_YUV444_2P_UV, 16, 16 },
|
|
{ DRM_FORMAT_NV42, SCALER_YUV444_2P_VU, 16, 16 },
|
|
{ DRM_FORMAT_YUV444, SCALER_YUV444_3P, 16, 16 },
|
|
{ DRM_FORMAT_RGB565, SCALER_RGB_565, 0, 0 },
|
|
{ DRM_FORMAT_XRGB1555, SCALER_ARGB1555, 0, 0 },
|
|
{ DRM_FORMAT_ARGB1555, SCALER_ARGB1555, 0, 0 },
|
|
{ DRM_FORMAT_XRGB4444, SCALER_ARGB4444, 0, 0 },
|
|
{ DRM_FORMAT_ARGB4444, SCALER_ARGB4444, 0, 0 },
|
|
{ DRM_FORMAT_XRGB8888, SCALER_ARGB8888, 0, 0 },
|
|
{ DRM_FORMAT_ARGB8888, SCALER_ARGB8888, 0, 0 },
|
|
{ DRM_FORMAT_RGBX8888, SCALER_RGBA8888, 0, 0 },
|
|
{ DRM_FORMAT_RGBA8888, SCALER_RGBA8888, 0, 0 },
|
|
};
|
|
|
|
static const struct scaler_format *scaler_get_format(u32 drm_fmt)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(scaler_formats); i++)
|
|
if (scaler_formats[i].drm_fmt == drm_fmt)
|
|
return &scaler_formats[i];
|
|
|
|
return NULL;
|
|
}
|
|
|
|
static inline int scaler_reset(struct scaler_context *scaler)
|
|
{
|
|
int retry = SCALER_RESET_WAIT_RETRIES;
|
|
|
|
scaler_write(SCALER_CFG_SOFT_RESET, SCALER_CFG);
|
|
do {
|
|
cpu_relax();
|
|
} while (retry > 1 &&
|
|
scaler_read(SCALER_CFG) & SCALER_CFG_SOFT_RESET);
|
|
do {
|
|
cpu_relax();
|
|
scaler_write(1, SCALER_INT_EN);
|
|
} while (retry > 0 && scaler_read(SCALER_INT_EN) != 1);
|
|
|
|
return retry ? 0 : -EIO;
|
|
}
|
|
|
|
static inline void scaler_enable_int(struct scaler_context *scaler)
|
|
{
|
|
u32 val;
|
|
|
|
val = SCALER_INT_EN_TIMEOUT |
|
|
SCALER_INT_EN_ILLEGAL_BLEND |
|
|
SCALER_INT_EN_ILLEGAL_RATIO |
|
|
SCALER_INT_EN_ILLEGAL_DST_HEIGHT |
|
|
SCALER_INT_EN_ILLEGAL_DST_WIDTH |
|
|
SCALER_INT_EN_ILLEGAL_DST_V_POS |
|
|
SCALER_INT_EN_ILLEGAL_DST_H_POS |
|
|
SCALER_INT_EN_ILLEGAL_DST_C_SPAN |
|
|
SCALER_INT_EN_ILLEGAL_DST_Y_SPAN |
|
|
SCALER_INT_EN_ILLEGAL_DST_CR_BASE |
|
|
SCALER_INT_EN_ILLEGAL_DST_CB_BASE |
|
|
SCALER_INT_EN_ILLEGAL_DST_Y_BASE |
|
|
SCALER_INT_EN_ILLEGAL_DST_COLOR |
|
|
SCALER_INT_EN_ILLEGAL_SRC_HEIGHT |
|
|
SCALER_INT_EN_ILLEGAL_SRC_WIDTH |
|
|
SCALER_INT_EN_ILLEGAL_SRC_CV_POS |
|
|
SCALER_INT_EN_ILLEGAL_SRC_CH_POS |
|
|
SCALER_INT_EN_ILLEGAL_SRC_YV_POS |
|
|
SCALER_INT_EN_ILLEGAL_SRC_YH_POS |
|
|
SCALER_INT_EN_ILLEGAL_DST_SPAN |
|
|
SCALER_INT_EN_ILLEGAL_SRC_Y_SPAN |
|
|
SCALER_INT_EN_ILLEGAL_SRC_CR_BASE |
|
|
SCALER_INT_EN_ILLEGAL_SRC_CB_BASE |
|
|
SCALER_INT_EN_ILLEGAL_SRC_Y_BASE |
|
|
SCALER_INT_EN_ILLEGAL_SRC_COLOR |
|
|
SCALER_INT_EN_FRAME_END;
|
|
scaler_write(val, SCALER_INT_EN);
|
|
}
|
|
|
|
static inline void scaler_set_src_fmt(struct scaler_context *scaler,
|
|
u32 src_fmt, u32 tile)
|
|
{
|
|
u32 val;
|
|
|
|
val = SCALER_SRC_CFG_SET_COLOR_FORMAT(src_fmt) | (tile << 10);
|
|
scaler_write(val, SCALER_SRC_CFG);
|
|
}
|
|
|
|
static inline void scaler_set_src_base(struct scaler_context *scaler,
|
|
struct exynos_drm_ipp_buffer *src_buf)
|
|
{
|
|
static unsigned int bases[] = {
|
|
SCALER_SRC_Y_BASE,
|
|
SCALER_SRC_CB_BASE,
|
|
SCALER_SRC_CR_BASE,
|
|
};
|
|
int i;
|
|
|
|
for (i = 0; i < src_buf->format->num_planes; ++i)
|
|
scaler_write(src_buf->dma_addr[i], bases[i]);
|
|
}
|
|
|
|
static inline void scaler_set_src_span(struct scaler_context *scaler,
|
|
struct exynos_drm_ipp_buffer *src_buf)
|
|
{
|
|
u32 val;
|
|
|
|
val = SCALER_SRC_SPAN_SET_Y_SPAN(src_buf->buf.pitch[0] /
|
|
src_buf->format->cpp[0]);
|
|
|
|
if (src_buf->format->num_planes > 1)
|
|
val |= SCALER_SRC_SPAN_SET_C_SPAN(src_buf->buf.pitch[1]);
|
|
|
|
scaler_write(val, SCALER_SRC_SPAN);
|
|
}
|
|
|
|
static inline void scaler_set_src_luma_chroma_pos(struct scaler_context *scaler,
|
|
struct drm_exynos_ipp_task_rect *src_pos,
|
|
const struct scaler_format *fmt)
|
|
{
|
|
u32 val;
|
|
|
|
val = SCALER_SRC_Y_POS_SET_YH_POS(src_pos->x << 2);
|
|
val |= SCALER_SRC_Y_POS_SET_YV_POS(src_pos->y << 2);
|
|
scaler_write(val, SCALER_SRC_Y_POS);
|
|
val = SCALER_SRC_C_POS_SET_CH_POS(
|
|
(src_pos->x * fmt->chroma_tile_w / 16) << 2);
|
|
val |= SCALER_SRC_C_POS_SET_CV_POS(
|
|
(src_pos->y * fmt->chroma_tile_h / 16) << 2);
|
|
scaler_write(val, SCALER_SRC_C_POS);
|
|
}
|
|
|
|
static inline void scaler_set_src_wh(struct scaler_context *scaler,
|
|
struct drm_exynos_ipp_task_rect *src_pos)
|
|
{
|
|
u32 val;
|
|
|
|
val = SCALER_SRC_WH_SET_WIDTH(src_pos->w);
|
|
val |= SCALER_SRC_WH_SET_HEIGHT(src_pos->h);
|
|
scaler_write(val, SCALER_SRC_WH);
|
|
}
|
|
|
|
static inline void scaler_set_dst_fmt(struct scaler_context *scaler,
|
|
u32 dst_fmt)
|
|
{
|
|
u32 val;
|
|
|
|
val = SCALER_DST_CFG_SET_COLOR_FORMAT(dst_fmt);
|
|
scaler_write(val, SCALER_DST_CFG);
|
|
}
|
|
|
|
static inline void scaler_set_dst_base(struct scaler_context *scaler,
|
|
struct exynos_drm_ipp_buffer *dst_buf)
|
|
{
|
|
static unsigned int bases[] = {
|
|
SCALER_DST_Y_BASE,
|
|
SCALER_DST_CB_BASE,
|
|
SCALER_DST_CR_BASE,
|
|
};
|
|
int i;
|
|
|
|
for (i = 0; i < dst_buf->format->num_planes; ++i)
|
|
scaler_write(dst_buf->dma_addr[i], bases[i]);
|
|
}
|
|
|
|
static inline void scaler_set_dst_span(struct scaler_context *scaler,
|
|
struct exynos_drm_ipp_buffer *dst_buf)
|
|
{
|
|
u32 val;
|
|
|
|
val = SCALER_DST_SPAN_SET_Y_SPAN(dst_buf->buf.pitch[0] /
|
|
dst_buf->format->cpp[0]);
|
|
|
|
if (dst_buf->format->num_planes > 1)
|
|
val |= SCALER_DST_SPAN_SET_C_SPAN(dst_buf->buf.pitch[1]);
|
|
|
|
scaler_write(val, SCALER_DST_SPAN);
|
|
}
|
|
|
|
static inline void scaler_set_dst_luma_pos(struct scaler_context *scaler,
|
|
struct drm_exynos_ipp_task_rect *dst_pos)
|
|
{
|
|
u32 val;
|
|
|
|
val = SCALER_DST_WH_SET_WIDTH(dst_pos->w);
|
|
val |= SCALER_DST_WH_SET_HEIGHT(dst_pos->h);
|
|
scaler_write(val, SCALER_DST_WH);
|
|
}
|
|
|
|
static inline void scaler_set_dst_wh(struct scaler_context *scaler,
|
|
struct drm_exynos_ipp_task_rect *dst_pos)
|
|
{
|
|
u32 val;
|
|
|
|
val = SCALER_DST_POS_SET_H_POS(dst_pos->x);
|
|
val |= SCALER_DST_POS_SET_V_POS(dst_pos->y);
|
|
scaler_write(val, SCALER_DST_POS);
|
|
}
|
|
|
|
static inline void scaler_set_hv_ratio(struct scaler_context *scaler,
|
|
unsigned int rotation,
|
|
struct drm_exynos_ipp_task_rect *src_pos,
|
|
struct drm_exynos_ipp_task_rect *dst_pos)
|
|
{
|
|
u32 val, h_ratio, v_ratio;
|
|
|
|
if (drm_rotation_90_or_270(rotation)) {
|
|
h_ratio = (src_pos->h << 16) / dst_pos->w;
|
|
v_ratio = (src_pos->w << 16) / dst_pos->h;
|
|
} else {
|
|
h_ratio = (src_pos->w << 16) / dst_pos->w;
|
|
v_ratio = (src_pos->h << 16) / dst_pos->h;
|
|
}
|
|
|
|
val = SCALER_H_RATIO_SET(h_ratio);
|
|
scaler_write(val, SCALER_H_RATIO);
|
|
|
|
val = SCALER_V_RATIO_SET(v_ratio);
|
|
scaler_write(val, SCALER_V_RATIO);
|
|
}
|
|
|
|
static inline void scaler_set_rotation(struct scaler_context *scaler,
|
|
unsigned int rotation)
|
|
{
|
|
u32 val = 0;
|
|
|
|
if (rotation & DRM_MODE_ROTATE_90)
|
|
val |= SCALER_ROT_CFG_SET_ROTMODE(SCALER_ROT_MODE_90);
|
|
else if (rotation & DRM_MODE_ROTATE_180)
|
|
val |= SCALER_ROT_CFG_SET_ROTMODE(SCALER_ROT_MODE_180);
|
|
else if (rotation & DRM_MODE_ROTATE_270)
|
|
val |= SCALER_ROT_CFG_SET_ROTMODE(SCALER_ROT_MODE_270);
|
|
if (rotation & DRM_MODE_REFLECT_X)
|
|
val |= SCALER_ROT_CFG_FLIP_X_EN;
|
|
if (rotation & DRM_MODE_REFLECT_Y)
|
|
val |= SCALER_ROT_CFG_FLIP_Y_EN;
|
|
scaler_write(val, SCALER_ROT_CFG);
|
|
}
|
|
|
|
static inline void scaler_set_csc(struct scaler_context *scaler,
|
|
const struct drm_format_info *fmt)
|
|
{
|
|
static const u32 csc_mtx[2][3][3] = {
|
|
{ /* YCbCr to RGB */
|
|
{0x254, 0x000, 0x331},
|
|
{0x254, 0xf38, 0xe60},
|
|
{0x254, 0x409, 0x000},
|
|
},
|
|
{ /* RGB to YCbCr */
|
|
{0x084, 0x102, 0x032},
|
|
{0xfb4, 0xf6b, 0x0e1},
|
|
{0x0e1, 0xf44, 0xfdc},
|
|
},
|
|
};
|
|
int i, j, dir;
|
|
|
|
switch (fmt->format) {
|
|
case DRM_FORMAT_RGB565:
|
|
case DRM_FORMAT_XRGB1555:
|
|
case DRM_FORMAT_ARGB1555:
|
|
case DRM_FORMAT_XRGB4444:
|
|
case DRM_FORMAT_ARGB4444:
|
|
case DRM_FORMAT_XRGB8888:
|
|
case DRM_FORMAT_ARGB8888:
|
|
case DRM_FORMAT_RGBX8888:
|
|
case DRM_FORMAT_RGBA8888:
|
|
dir = 1;
|
|
break;
|
|
default:
|
|
dir = 0;
|
|
}
|
|
|
|
for (i = 0; i < 3; i++)
|
|
for (j = 0; j < 3; j++)
|
|
scaler_write(csc_mtx[dir][i][j], SCALER_CSC_COEF(j, i));
|
|
}
|
|
|
|
static inline void scaler_set_timer(struct scaler_context *scaler,
|
|
unsigned int timer, unsigned int divider)
|
|
{
|
|
u32 val;
|
|
|
|
val = SCALER_TIMEOUT_CTRL_TIMER_ENABLE;
|
|
val |= SCALER_TIMEOUT_CTRL_SET_TIMER_VALUE(timer);
|
|
val |= SCALER_TIMEOUT_CTRL_SET_TIMER_DIV(divider);
|
|
scaler_write(val, SCALER_TIMEOUT_CTRL);
|
|
}
|
|
|
|
static inline void scaler_start_hw(struct scaler_context *scaler)
|
|
{
|
|
scaler_write(SCALER_CFG_START_CMD, SCALER_CFG);
|
|
}
|
|
|
|
static int scaler_commit(struct exynos_drm_ipp *ipp,
|
|
struct exynos_drm_ipp_task *task)
|
|
{
|
|
struct scaler_context *scaler =
|
|
container_of(ipp, struct scaler_context, ipp);
|
|
|
|
struct drm_exynos_ipp_task_rect *src_pos = &task->src.rect;
|
|
struct drm_exynos_ipp_task_rect *dst_pos = &task->dst.rect;
|
|
const struct scaler_format *src_fmt, *dst_fmt;
|
|
|
|
src_fmt = scaler_get_format(task->src.buf.fourcc);
|
|
dst_fmt = scaler_get_format(task->dst.buf.fourcc);
|
|
|
|
pm_runtime_get_sync(scaler->dev);
|
|
if (scaler_reset(scaler)) {
|
|
pm_runtime_put(scaler->dev);
|
|
return -EIO;
|
|
}
|
|
|
|
scaler->task = task;
|
|
|
|
scaler_set_src_fmt(
|
|
scaler, src_fmt->internal_fmt, task->src.buf.modifier != 0);
|
|
scaler_set_src_base(scaler, &task->src);
|
|
scaler_set_src_span(scaler, &task->src);
|
|
scaler_set_src_luma_chroma_pos(scaler, src_pos, src_fmt);
|
|
scaler_set_src_wh(scaler, src_pos);
|
|
|
|
scaler_set_dst_fmt(scaler, dst_fmt->internal_fmt);
|
|
scaler_set_dst_base(scaler, &task->dst);
|
|
scaler_set_dst_span(scaler, &task->dst);
|
|
scaler_set_dst_luma_pos(scaler, dst_pos);
|
|
scaler_set_dst_wh(scaler, dst_pos);
|
|
|
|
scaler_set_hv_ratio(scaler, task->transform.rotation, src_pos, dst_pos);
|
|
scaler_set_rotation(scaler, task->transform.rotation);
|
|
|
|
scaler_set_csc(scaler, task->src.format);
|
|
|
|
scaler_set_timer(scaler, 0xffff, 0xf);
|
|
|
|
scaler_enable_int(scaler);
|
|
scaler_start_hw(scaler);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct exynos_drm_ipp_funcs ipp_funcs = {
|
|
.commit = scaler_commit,
|
|
};
|
|
|
|
static inline void scaler_disable_int(struct scaler_context *scaler)
|
|
{
|
|
scaler_write(0, SCALER_INT_EN);
|
|
}
|
|
|
|
static inline u32 scaler_get_int_status(struct scaler_context *scaler)
|
|
{
|
|
u32 val = scaler_read(SCALER_INT_STATUS);
|
|
|
|
scaler_write(val, SCALER_INT_STATUS);
|
|
|
|
return val;
|
|
}
|
|
|
|
static inline int scaler_task_done(u32 val)
|
|
{
|
|
return val & SCALER_INT_STATUS_FRAME_END ? 0 : -EINVAL;
|
|
}
|
|
|
|
static irqreturn_t scaler_irq_handler(int irq, void *arg)
|
|
{
|
|
struct scaler_context *scaler = arg;
|
|
|
|
u32 val = scaler_get_int_status(scaler);
|
|
|
|
scaler_disable_int(scaler);
|
|
|
|
if (scaler->task) {
|
|
struct exynos_drm_ipp_task *task = scaler->task;
|
|
|
|
scaler->task = NULL;
|
|
pm_runtime_mark_last_busy(scaler->dev);
|
|
pm_runtime_put_autosuspend(scaler->dev);
|
|
exynos_drm_ipp_task_done(task, scaler_task_done(val));
|
|
}
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
static int scaler_bind(struct device *dev, struct device *master, void *data)
|
|
{
|
|
struct scaler_context *scaler = dev_get_drvdata(dev);
|
|
struct drm_device *drm_dev = data;
|
|
struct exynos_drm_ipp *ipp = &scaler->ipp;
|
|
|
|
scaler->drm_dev = drm_dev;
|
|
exynos_drm_register_dma(drm_dev, dev);
|
|
|
|
exynos_drm_ipp_register(drm_dev, ipp, &ipp_funcs,
|
|
DRM_EXYNOS_IPP_CAP_CROP | DRM_EXYNOS_IPP_CAP_ROTATE |
|
|
DRM_EXYNOS_IPP_CAP_SCALE | DRM_EXYNOS_IPP_CAP_CONVERT,
|
|
scaler->scaler_data->formats,
|
|
scaler->scaler_data->num_formats, "scaler");
|
|
|
|
dev_info(dev, "The exynos scaler has been probed successfully\n");
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void scaler_unbind(struct device *dev, struct device *master,
|
|
void *data)
|
|
{
|
|
struct scaler_context *scaler = dev_get_drvdata(dev);
|
|
struct drm_device *drm_dev = data;
|
|
struct exynos_drm_ipp *ipp = &scaler->ipp;
|
|
|
|
exynos_drm_ipp_unregister(drm_dev, ipp);
|
|
exynos_drm_unregister_dma(scaler->drm_dev, scaler->dev);
|
|
}
|
|
|
|
static const struct component_ops scaler_component_ops = {
|
|
.bind = scaler_bind,
|
|
.unbind = scaler_unbind,
|
|
};
|
|
|
|
static int scaler_probe(struct platform_device *pdev)
|
|
{
|
|
struct device *dev = &pdev->dev;
|
|
struct resource *regs_res;
|
|
struct scaler_context *scaler;
|
|
int irq;
|
|
int ret, i;
|
|
|
|
scaler = devm_kzalloc(dev, sizeof(*scaler), GFP_KERNEL);
|
|
if (!scaler)
|
|
return -ENOMEM;
|
|
|
|
scaler->scaler_data =
|
|
(struct scaler_data *)of_device_get_match_data(dev);
|
|
|
|
scaler->dev = dev;
|
|
regs_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
scaler->regs = devm_ioremap_resource(dev, regs_res);
|
|
if (IS_ERR(scaler->regs))
|
|
return PTR_ERR(scaler->regs);
|
|
|
|
irq = platform_get_irq(pdev, 0);
|
|
if (irq < 0) {
|
|
dev_err(dev, "failed to get irq\n");
|
|
return irq;
|
|
}
|
|
|
|
ret = devm_request_threaded_irq(dev, irq, NULL, scaler_irq_handler,
|
|
IRQF_ONESHOT, "drm_scaler", scaler);
|
|
if (ret < 0) {
|
|
dev_err(dev, "failed to request irq\n");
|
|
return ret;
|
|
}
|
|
|
|
for (i = 0; i < scaler->scaler_data->num_clk; ++i) {
|
|
scaler->clock[i] = devm_clk_get(dev,
|
|
scaler->scaler_data->clk_name[i]);
|
|
if (IS_ERR(scaler->clock[i])) {
|
|
dev_err(dev, "failed to get clock\n");
|
|
return PTR_ERR(scaler->clock[i]);
|
|
}
|
|
}
|
|
|
|
pm_runtime_use_autosuspend(dev);
|
|
pm_runtime_set_autosuspend_delay(dev, SCALER_AUTOSUSPEND_DELAY);
|
|
pm_runtime_enable(dev);
|
|
platform_set_drvdata(pdev, scaler);
|
|
|
|
ret = component_add(dev, &scaler_component_ops);
|
|
if (ret)
|
|
goto err_ippdrv_register;
|
|
|
|
return 0;
|
|
|
|
err_ippdrv_register:
|
|
pm_runtime_dont_use_autosuspend(dev);
|
|
pm_runtime_disable(dev);
|
|
return ret;
|
|
}
|
|
|
|
static int scaler_remove(struct platform_device *pdev)
|
|
{
|
|
struct device *dev = &pdev->dev;
|
|
|
|
component_del(dev, &scaler_component_ops);
|
|
pm_runtime_dont_use_autosuspend(dev);
|
|
pm_runtime_disable(dev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_PM
|
|
|
|
static int clk_disable_unprepare_wrapper(struct clk *clk)
|
|
{
|
|
clk_disable_unprepare(clk);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int scaler_clk_ctrl(struct scaler_context *scaler, bool enable)
|
|
{
|
|
int (*clk_fun)(struct clk *clk), i;
|
|
|
|
clk_fun = enable ? clk_prepare_enable : clk_disable_unprepare_wrapper;
|
|
|
|
for (i = 0; i < scaler->scaler_data->num_clk; ++i)
|
|
clk_fun(scaler->clock[i]);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int scaler_runtime_suspend(struct device *dev)
|
|
{
|
|
struct scaler_context *scaler = dev_get_drvdata(dev);
|
|
|
|
return scaler_clk_ctrl(scaler, false);
|
|
}
|
|
|
|
static int scaler_runtime_resume(struct device *dev)
|
|
{
|
|
struct scaler_context *scaler = dev_get_drvdata(dev);
|
|
|
|
return scaler_clk_ctrl(scaler, true);
|
|
}
|
|
#endif
|
|
|
|
static const struct dev_pm_ops scaler_pm_ops = {
|
|
SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend,
|
|
pm_runtime_force_resume)
|
|
SET_RUNTIME_PM_OPS(scaler_runtime_suspend, scaler_runtime_resume, NULL)
|
|
};
|
|
|
|
static const struct drm_exynos_ipp_limit scaler_5420_two_pixel_hv_limits[] = {
|
|
{ IPP_SIZE_LIMIT(BUFFER, .h = { 16, SZ_8K }, .v = { 16, SZ_8K }) },
|
|
{ IPP_SIZE_LIMIT(AREA, .h.align = 2, .v.align = 2) },
|
|
{ IPP_SCALE_LIMIT(.h = { 65536 * 1 / 4, 65536 * 16 },
|
|
.v = { 65536 * 1 / 4, 65536 * 16 }) },
|
|
};
|
|
|
|
static const struct drm_exynos_ipp_limit scaler_5420_two_pixel_h_limits[] = {
|
|
{ IPP_SIZE_LIMIT(BUFFER, .h = { 16, SZ_8K }, .v = { 16, SZ_8K }) },
|
|
{ IPP_SIZE_LIMIT(AREA, .h.align = 2, .v.align = 1) },
|
|
{ IPP_SCALE_LIMIT(.h = { 65536 * 1 / 4, 65536 * 16 },
|
|
.v = { 65536 * 1 / 4, 65536 * 16 }) },
|
|
};
|
|
|
|
static const struct drm_exynos_ipp_limit scaler_5420_one_pixel_limits[] = {
|
|
{ IPP_SIZE_LIMIT(BUFFER, .h = { 16, SZ_8K }, .v = { 16, SZ_8K }) },
|
|
{ IPP_SCALE_LIMIT(.h = { 65536 * 1 / 4, 65536 * 16 },
|
|
.v = { 65536 * 1 / 4, 65536 * 16 }) },
|
|
};
|
|
|
|
static const struct drm_exynos_ipp_limit scaler_5420_tile_limits[] = {
|
|
{ IPP_SIZE_LIMIT(BUFFER, .h = { 16, SZ_8K }, .v = { 16, SZ_8K })},
|
|
{ IPP_SIZE_LIMIT(AREA, .h.align = 16, .v.align = 16) },
|
|
{ IPP_SCALE_LIMIT(.h = {1, 1}, .v = {1, 1})},
|
|
{ }
|
|
};
|
|
|
|
#define IPP_SRCDST_TILE_FORMAT(f, l) \
|
|
IPP_SRCDST_MFORMAT(f, DRM_FORMAT_MOD_SAMSUNG_16_16_TILE, (l))
|
|
|
|
static const struct exynos_drm_ipp_formats exynos5420_formats[] = {
|
|
/* SCALER_YUV420_2P_UV */
|
|
{ IPP_SRCDST_FORMAT(NV21, scaler_5420_two_pixel_hv_limits) },
|
|
|
|
/* SCALER_YUV420_2P_VU */
|
|
{ IPP_SRCDST_FORMAT(NV12, scaler_5420_two_pixel_hv_limits) },
|
|
|
|
/* SCALER_YUV420_3P */
|
|
{ IPP_SRCDST_FORMAT(YUV420, scaler_5420_two_pixel_hv_limits) },
|
|
|
|
/* SCALER_YUV422_1P_YUYV */
|
|
{ IPP_SRCDST_FORMAT(YUYV, scaler_5420_two_pixel_h_limits) },
|
|
|
|
/* SCALER_YUV422_1P_UYVY */
|
|
{ IPP_SRCDST_FORMAT(UYVY, scaler_5420_two_pixel_h_limits) },
|
|
|
|
/* SCALER_YUV422_1P_YVYU */
|
|
{ IPP_SRCDST_FORMAT(YVYU, scaler_5420_two_pixel_h_limits) },
|
|
|
|
/* SCALER_YUV422_2P_UV */
|
|
{ IPP_SRCDST_FORMAT(NV61, scaler_5420_two_pixel_h_limits) },
|
|
|
|
/* SCALER_YUV422_2P_VU */
|
|
{ IPP_SRCDST_FORMAT(NV16, scaler_5420_two_pixel_h_limits) },
|
|
|
|
/* SCALER_YUV422_3P */
|
|
{ IPP_SRCDST_FORMAT(YUV422, scaler_5420_two_pixel_h_limits) },
|
|
|
|
/* SCALER_YUV444_2P_UV */
|
|
{ IPP_SRCDST_FORMAT(NV42, scaler_5420_one_pixel_limits) },
|
|
|
|
/* SCALER_YUV444_2P_VU */
|
|
{ IPP_SRCDST_FORMAT(NV24, scaler_5420_one_pixel_limits) },
|
|
|
|
/* SCALER_YUV444_3P */
|
|
{ IPP_SRCDST_FORMAT(YUV444, scaler_5420_one_pixel_limits) },
|
|
|
|
/* SCALER_RGB_565 */
|
|
{ IPP_SRCDST_FORMAT(RGB565, scaler_5420_one_pixel_limits) },
|
|
|
|
/* SCALER_ARGB1555 */
|
|
{ IPP_SRCDST_FORMAT(XRGB1555, scaler_5420_one_pixel_limits) },
|
|
|
|
/* SCALER_ARGB1555 */
|
|
{ IPP_SRCDST_FORMAT(ARGB1555, scaler_5420_one_pixel_limits) },
|
|
|
|
/* SCALER_ARGB4444 */
|
|
{ IPP_SRCDST_FORMAT(XRGB4444, scaler_5420_one_pixel_limits) },
|
|
|
|
/* SCALER_ARGB4444 */
|
|
{ IPP_SRCDST_FORMAT(ARGB4444, scaler_5420_one_pixel_limits) },
|
|
|
|
/* SCALER_ARGB8888 */
|
|
{ IPP_SRCDST_FORMAT(XRGB8888, scaler_5420_one_pixel_limits) },
|
|
|
|
/* SCALER_ARGB8888 */
|
|
{ IPP_SRCDST_FORMAT(ARGB8888, scaler_5420_one_pixel_limits) },
|
|
|
|
/* SCALER_RGBA8888 */
|
|
{ IPP_SRCDST_FORMAT(RGBX8888, scaler_5420_one_pixel_limits) },
|
|
|
|
/* SCALER_RGBA8888 */
|
|
{ IPP_SRCDST_FORMAT(RGBA8888, scaler_5420_one_pixel_limits) },
|
|
|
|
/* SCALER_YUV420_2P_UV TILE */
|
|
{ IPP_SRCDST_TILE_FORMAT(NV21, scaler_5420_tile_limits) },
|
|
|
|
/* SCALER_YUV420_2P_VU TILE */
|
|
{ IPP_SRCDST_TILE_FORMAT(NV12, scaler_5420_tile_limits) },
|
|
|
|
/* SCALER_YUV420_3P TILE */
|
|
{ IPP_SRCDST_TILE_FORMAT(YUV420, scaler_5420_tile_limits) },
|
|
|
|
/* SCALER_YUV422_1P_YUYV TILE */
|
|
{ IPP_SRCDST_TILE_FORMAT(YUYV, scaler_5420_tile_limits) },
|
|
};
|
|
|
|
static const struct scaler_data exynos5420_data = {
|
|
.clk_name = {"mscl"},
|
|
.num_clk = 1,
|
|
.formats = exynos5420_formats,
|
|
.num_formats = ARRAY_SIZE(exynos5420_formats),
|
|
};
|
|
|
|
static const struct scaler_data exynos5433_data = {
|
|
.clk_name = {"pclk", "aclk", "aclk_xiu"},
|
|
.num_clk = 3,
|
|
.formats = exynos5420_formats, /* intentional */
|
|
.num_formats = ARRAY_SIZE(exynos5420_formats),
|
|
};
|
|
|
|
static const struct of_device_id exynos_scaler_match[] = {
|
|
{
|
|
.compatible = "samsung,exynos5420-scaler",
|
|
.data = &exynos5420_data,
|
|
}, {
|
|
.compatible = "samsung,exynos5433-scaler",
|
|
.data = &exynos5433_data,
|
|
}, {
|
|
},
|
|
};
|
|
MODULE_DEVICE_TABLE(of, exynos_scaler_match);
|
|
|
|
struct platform_driver scaler_driver = {
|
|
.probe = scaler_probe,
|
|
.remove = scaler_remove,
|
|
.driver = {
|
|
.name = "exynos-scaler",
|
|
.owner = THIS_MODULE,
|
|
.pm = &scaler_pm_ops,
|
|
.of_match_table = exynos_scaler_match,
|
|
},
|
|
};
|