|  | // SPDX-License-Identifier: GPL-2.0-only | 
|  | /* | 
|  | * Copyright (C) 2017 Samsung Electronics Co.Ltd | 
|  | * Author: | 
|  | *	Andrzej Pietrasiewicz <andrzejtp2010@gmail.com> | 
|  | */ | 
|  |  | 
|  | #include <linux/clk.h> | 
|  | #include <linux/component.h> | 
|  | #include <linux/err.h> | 
|  | #include <linux/interrupt.h> | 
|  | #include <linux/io.h> | 
|  | #include <linux/kernel.h> | 
|  | #include <linux/of.h> | 
|  | #include <linux/platform_device.h> | 
|  | #include <linux/pm_runtime.h> | 
|  |  | 
|  | #include <drm/drm_blend.h> | 
|  | #include <drm/drm_fourcc.h> | 
|  | #include <drm/exynos_drm.h> | 
|  |  | 
|  | #include "exynos_drm_drv.h" | 
|  | #include "exynos_drm_fb.h" | 
|  | #include "exynos_drm_ipp.h" | 
|  | #include "regs-scaler.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; | 
|  | void				*dma_priv; | 
|  | 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; | 
|  | int ret = 0; | 
|  |  | 
|  | src_fmt = scaler_get_format(task->src.buf.fourcc); | 
|  | dst_fmt = scaler_get_format(task->dst.buf.fourcc); | 
|  |  | 
|  | ret = pm_runtime_resume_and_get(scaler->dev); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | if (scaler_reset(scaler)) | 
|  | 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 const 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; | 
|  | ipp->drm_dev = drm_dev; | 
|  | exynos_drm_register_dma(drm_dev, dev, &scaler->dma_priv); | 
|  |  | 
|  | exynos_drm_ipp_register(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 exynos_drm_ipp *ipp = &scaler->ipp; | 
|  |  | 
|  | exynos_drm_ipp_unregister(dev, ipp); | 
|  | exynos_drm_unregister_dma(scaler->drm_dev, scaler->dev, | 
|  | &scaler->dma_priv); | 
|  | } | 
|  |  | 
|  | 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 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; | 
|  | scaler->regs = devm_platform_ioremap_resource(pdev, 0); | 
|  | if (IS_ERR(scaler->regs)) | 
|  | return PTR_ERR(scaler->regs); | 
|  |  | 
|  | irq = platform_get_irq(pdev, 0); | 
|  | if (irq < 0) | 
|  | 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 void 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); | 
|  | } | 
|  |  | 
|  | 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); | 
|  | } | 
|  |  | 
|  | static DEFINE_RUNTIME_DEV_PM_OPS(scaler_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_new	= scaler_remove, | 
|  | .driver		= { | 
|  | .name	= "exynos-scaler", | 
|  | .pm	= pm_ptr(&scaler_pm_ops), | 
|  | .of_match_table = exynos_scaler_match, | 
|  | }, | 
|  | }; |