| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | /*
 | 
					
						
							|  |  |  |  * Copyright (C) 2012 Samsung Electronics Co.Ltd | 
					
						
							|  |  |  |  * Authors: | 
					
						
							|  |  |  |  *	YoungJun Cho <yj44.cho@samsung.com> | 
					
						
							|  |  |  |  *	Eunchul Kim <chulspro.kim@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/err.h>
 | 
					
						
							|  |  |  | #include <linux/interrupt.h>
 | 
					
						
							|  |  |  | #include <linux/io.h>
 | 
					
						
							|  |  |  | #include <linux/platform_device.h>
 | 
					
						
							|  |  |  | #include <linux/clk.h>
 | 
					
						
							|  |  |  | #include <linux/pm_runtime.h>
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #include <drm/drmP.h>
 | 
					
						
							|  |  |  | #include <drm/exynos_drm.h>
 | 
					
						
							|  |  |  | #include "regs-rotator.h"
 | 
					
						
							|  |  |  | #include "exynos_drm.h"
 | 
					
						
							| 
									
										
										
										
											2013-08-13 00:46:40 +01:00
										 |  |  | #include "exynos_drm_drv.h"
 | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | #include "exynos_drm_ipp.h"
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * Rotator supports image crop/rotator and input/output DMA operations. | 
					
						
							|  |  |  |  * input DMA reads image data from the memory. | 
					
						
							|  |  |  |  * output DMA writes image data to memory. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * M2M operation : supports crop/scale/rotation/csc so on. | 
					
						
							|  |  |  |  * Memory ----> Rotator H/W ----> Memory. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * TODO | 
					
						
							|  |  |  |  * 1. check suspend/resume api if needed. | 
					
						
							|  |  |  |  * 2. need to check use case platform_device_id. | 
					
						
							|  |  |  |  * 3. check src/dst size with, height. | 
					
						
							|  |  |  |  * 4. need to add supported list in prop_list. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #define get_rot_context(dev)	platform_get_drvdata(to_platform_device(dev))
 | 
					
						
							|  |  |  | #define get_ctx_from_ippdrv(ippdrv)	container_of(ippdrv,\
 | 
					
						
							|  |  |  | 					struct rot_context, ippdrv); | 
					
						
							|  |  |  | #define rot_read(offset)		readl(rot->regs + (offset))
 | 
					
						
							|  |  |  | #define rot_write(cfg, offset)	writel(cfg, rot->regs + (offset))
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | enum rot_irq_status { | 
					
						
							|  |  |  | 	ROT_IRQ_STATUS_COMPLETE	= 8, | 
					
						
							|  |  |  | 	ROT_IRQ_STATUS_ILLEGAL	= 9, | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * A structure of limitation. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * @min_w: minimum width. | 
					
						
							|  |  |  |  * @min_h: minimum height. | 
					
						
							|  |  |  |  * @max_w: maximum width. | 
					
						
							|  |  |  |  * @max_h: maximum height. | 
					
						
							|  |  |  |  * @align: align size. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | struct rot_limit { | 
					
						
							|  |  |  | 	u32	min_w; | 
					
						
							|  |  |  | 	u32	min_h; | 
					
						
							|  |  |  | 	u32	max_w; | 
					
						
							|  |  |  | 	u32	max_h; | 
					
						
							|  |  |  | 	u32	align; | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * A structure of limitation table. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * @ycbcr420_2p: case of YUV. | 
					
						
							|  |  |  |  * @rgb888: case of RGB. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | struct rot_limit_table { | 
					
						
							|  |  |  | 	struct rot_limit	ycbcr420_2p; | 
					
						
							|  |  |  | 	struct rot_limit	rgb888; | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * A structure of rotator context. | 
					
						
							|  |  |  |  * @ippdrv: prepare initialization using ippdrv. | 
					
						
							|  |  |  |  * @regs_res: register resources. | 
					
						
							|  |  |  |  * @regs: memory mapped io registers. | 
					
						
							|  |  |  |  * @clock: rotator gate clock. | 
					
						
							|  |  |  |  * @limit_tbl: limitation of rotator. | 
					
						
							|  |  |  |  * @irq: irq number. | 
					
						
							|  |  |  |  * @cur_buf_id: current operation buffer id. | 
					
						
							|  |  |  |  * @suspended: suspended state. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | struct rot_context { | 
					
						
							|  |  |  | 	struct exynos_drm_ippdrv	ippdrv; | 
					
						
							|  |  |  | 	struct resource	*regs_res; | 
					
						
							|  |  |  | 	void __iomem	*regs; | 
					
						
							|  |  |  | 	struct clk	*clock; | 
					
						
							|  |  |  | 	struct rot_limit_table	*limit_tbl; | 
					
						
							|  |  |  | 	int	irq; | 
					
						
							|  |  |  | 	int	cur_buf_id[EXYNOS_DRM_OPS_MAX]; | 
					
						
							|  |  |  | 	bool	suspended; | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static void rotator_reg_set_irq(struct rot_context *rot, bool enable) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	u32 val = rot_read(ROT_CONFIG); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (enable == true) | 
					
						
							|  |  |  | 		val |= ROT_CONFIG_IRQ; | 
					
						
							|  |  |  | 	else | 
					
						
							|  |  |  | 		val &= ~ROT_CONFIG_IRQ; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	rot_write(val, ROT_CONFIG); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static u32 rotator_reg_get_fmt(struct rot_context *rot) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	u32 val = rot_read(ROT_CONTROL); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	val &= ROT_CONTROL_FMT_MASK; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return val; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static enum rot_irq_status rotator_reg_get_irq_status(struct rot_context *rot) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	u32 val = rot_read(ROT_STATUS); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	val = ROT_STATUS_IRQ(val); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (val == ROT_STATUS_IRQ_VAL_COMPLETE) | 
					
						
							|  |  |  | 		return ROT_IRQ_STATUS_COMPLETE; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return ROT_IRQ_STATUS_ILLEGAL; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static irqreturn_t rotator_irq_handler(int irq, void *arg) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct rot_context *rot = arg; | 
					
						
							|  |  |  | 	struct exynos_drm_ippdrv *ippdrv = &rot->ippdrv; | 
					
						
							| 
									
										
										
										
											2012-12-22 17:49:22 +09:00
										 |  |  | 	struct drm_exynos_ipp_cmd_node *c_node = ippdrv->c_node; | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 	struct drm_exynos_ipp_event_work *event_work = c_node->event_work; | 
					
						
							|  |  |  | 	enum rot_irq_status irq_status; | 
					
						
							|  |  |  | 	u32 val; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Get execution result */ | 
					
						
							|  |  |  | 	irq_status = rotator_reg_get_irq_status(rot); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* clear status */ | 
					
						
							|  |  |  | 	val = rot_read(ROT_STATUS); | 
					
						
							|  |  |  | 	val |= ROT_STATUS_IRQ_PENDING((u32)irq_status); | 
					
						
							|  |  |  | 	rot_write(val, ROT_STATUS); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (irq_status == ROT_IRQ_STATUS_COMPLETE) { | 
					
						
							|  |  |  | 		event_work->ippdrv = ippdrv; | 
					
						
							|  |  |  | 		event_work->buf_id[EXYNOS_DRM_OPS_DST] = | 
					
						
							|  |  |  | 			rot->cur_buf_id[EXYNOS_DRM_OPS_DST]; | 
					
						
							| 
									
										
										
										
											2014-08-28 11:07:33 +02:00
										 |  |  | 		queue_work(ippdrv->event_workq, &event_work->work); | 
					
						
							| 
									
										
										
										
											2014-04-17 19:09:00 +09:00
										 |  |  | 	} else { | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 		DRM_ERROR("the SFR is set illegally\n"); | 
					
						
							| 
									
										
										
										
											2014-04-17 19:09:00 +09:00
										 |  |  | 	} | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	return IRQ_HANDLED; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static void rotator_align_size(struct rot_context *rot, u32 fmt, u32 *hsize, | 
					
						
							|  |  |  | 		u32 *vsize) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct rot_limit_table *limit_tbl = rot->limit_tbl; | 
					
						
							|  |  |  | 	struct rot_limit *limit; | 
					
						
							|  |  |  | 	u32 mask, val; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Get size limit */ | 
					
						
							|  |  |  | 	if (fmt == ROT_CONTROL_FMT_RGB888) | 
					
						
							|  |  |  | 		limit = &limit_tbl->rgb888; | 
					
						
							|  |  |  | 	else | 
					
						
							|  |  |  | 		limit = &limit_tbl->ycbcr420_2p; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Get mask for rounding to nearest aligned val */ | 
					
						
							|  |  |  | 	mask = ~((1 << limit->align) - 1); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Set aligned width */ | 
					
						
							|  |  |  | 	val = ROT_ALIGN(*hsize, limit->align, mask); | 
					
						
							|  |  |  | 	if (val < limit->min_w) | 
					
						
							|  |  |  | 		*hsize = ROT_MIN(limit->min_w, mask); | 
					
						
							|  |  |  | 	else if (val > limit->max_w) | 
					
						
							|  |  |  | 		*hsize = ROT_MAX(limit->max_w, mask); | 
					
						
							|  |  |  | 	else | 
					
						
							|  |  |  | 		*hsize = val; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Set aligned height */ | 
					
						
							|  |  |  | 	val = ROT_ALIGN(*vsize, limit->align, mask); | 
					
						
							|  |  |  | 	if (val < limit->min_h) | 
					
						
							|  |  |  | 		*vsize = ROT_MIN(limit->min_h, mask); | 
					
						
							|  |  |  | 	else if (val > limit->max_h) | 
					
						
							|  |  |  | 		*vsize = ROT_MAX(limit->max_h, mask); | 
					
						
							|  |  |  | 	else | 
					
						
							|  |  |  | 		*vsize = val; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static int rotator_src_set_fmt(struct device *dev, u32 fmt) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct rot_context *rot = dev_get_drvdata(dev); | 
					
						
							|  |  |  | 	u32 val; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	val = rot_read(ROT_CONTROL); | 
					
						
							|  |  |  | 	val &= ~ROT_CONTROL_FMT_MASK; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	switch (fmt) { | 
					
						
							|  |  |  | 	case DRM_FORMAT_NV12: | 
					
						
							|  |  |  | 		val |= ROT_CONTROL_FMT_YCBCR420_2P; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	case DRM_FORMAT_XRGB8888: | 
					
						
							|  |  |  | 		val |= ROT_CONTROL_FMT_RGB888; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	default: | 
					
						
							|  |  |  | 		DRM_ERROR("invalid image format\n"); | 
					
						
							|  |  |  | 		return -EINVAL; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	rot_write(val, ROT_CONTROL); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static inline bool rotator_check_reg_fmt(u32 fmt) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	if ((fmt == ROT_CONTROL_FMT_YCBCR420_2P) || | 
					
						
							|  |  |  | 	    (fmt == ROT_CONTROL_FMT_RGB888)) | 
					
						
							|  |  |  | 		return true; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return false; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static int rotator_src_set_size(struct device *dev, int swap, | 
					
						
							|  |  |  | 		struct drm_exynos_pos *pos, | 
					
						
							|  |  |  | 		struct drm_exynos_sz *sz) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct rot_context *rot = dev_get_drvdata(dev); | 
					
						
							|  |  |  | 	u32 fmt, hsize, vsize; | 
					
						
							|  |  |  | 	u32 val; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Get format */ | 
					
						
							|  |  |  | 	fmt = rotator_reg_get_fmt(rot); | 
					
						
							|  |  |  | 	if (!rotator_check_reg_fmt(fmt)) { | 
					
						
							| 
									
										
										
										
											2013-06-12 10:44:40 +09:00
										 |  |  | 		DRM_ERROR("invalid format.\n"); | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 		return -EINVAL; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Align buffer size */ | 
					
						
							|  |  |  | 	hsize = sz->hsize; | 
					
						
							|  |  |  | 	vsize = sz->vsize; | 
					
						
							|  |  |  | 	rotator_align_size(rot, fmt, &hsize, &vsize); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Set buffer size configuration */ | 
					
						
							|  |  |  | 	val = ROT_SET_BUF_SIZE_H(vsize) | ROT_SET_BUF_SIZE_W(hsize); | 
					
						
							|  |  |  | 	rot_write(val, ROT_SRC_BUF_SIZE); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Set crop image position configuration */ | 
					
						
							|  |  |  | 	val = ROT_CROP_POS_Y(pos->y) | ROT_CROP_POS_X(pos->x); | 
					
						
							|  |  |  | 	rot_write(val, ROT_SRC_CROP_POS); | 
					
						
							|  |  |  | 	val = ROT_SRC_CROP_SIZE_H(pos->h) | ROT_SRC_CROP_SIZE_W(pos->w); | 
					
						
							|  |  |  | 	rot_write(val, ROT_SRC_CROP_SIZE); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static int rotator_src_set_addr(struct device *dev, | 
					
						
							|  |  |  | 		struct drm_exynos_ipp_buf_info *buf_info, | 
					
						
							|  |  |  | 		u32 buf_id, enum drm_exynos_ipp_buf_type buf_type) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct rot_context *rot = dev_get_drvdata(dev); | 
					
						
							|  |  |  | 	dma_addr_t addr[EXYNOS_DRM_PLANAR_MAX]; | 
					
						
							|  |  |  | 	u32 val, fmt, hsize, vsize; | 
					
						
							|  |  |  | 	int i; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Set current buf_id */ | 
					
						
							|  |  |  | 	rot->cur_buf_id[EXYNOS_DRM_OPS_SRC] = buf_id; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	switch (buf_type) { | 
					
						
							|  |  |  | 	case IPP_BUF_ENQUEUE: | 
					
						
							|  |  |  | 		/* Set address configuration */ | 
					
						
							|  |  |  | 		for_each_ipp_planar(i) | 
					
						
							|  |  |  | 			addr[i] = buf_info->base[i]; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		/* Get format */ | 
					
						
							|  |  |  | 		fmt = rotator_reg_get_fmt(rot); | 
					
						
							|  |  |  | 		if (!rotator_check_reg_fmt(fmt)) { | 
					
						
							| 
									
										
										
										
											2013-06-12 10:44:40 +09:00
										 |  |  | 			DRM_ERROR("invalid format.\n"); | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 			return -EINVAL; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		/* Re-set cb planar for NV12 format */ | 
					
						
							|  |  |  | 		if ((fmt == ROT_CONTROL_FMT_YCBCR420_2P) && | 
					
						
							|  |  |  | 		    !addr[EXYNOS_DRM_PLANAR_CB]) { | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 			val = rot_read(ROT_SRC_BUF_SIZE); | 
					
						
							|  |  |  | 			hsize = ROT_GET_BUF_SIZE_W(val); | 
					
						
							|  |  |  | 			vsize = ROT_GET_BUF_SIZE_H(val); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 			/* Set cb planar */ | 
					
						
							|  |  |  | 			addr[EXYNOS_DRM_PLANAR_CB] = | 
					
						
							|  |  |  | 				addr[EXYNOS_DRM_PLANAR_Y] + hsize * vsize; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		for_each_ipp_planar(i) | 
					
						
							|  |  |  | 			rot_write(addr[i], ROT_SRC_BUF_ADDR(i)); | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	case IPP_BUF_DEQUEUE: | 
					
						
							|  |  |  | 		for_each_ipp_planar(i) | 
					
						
							|  |  |  | 			rot_write(0x0, ROT_SRC_BUF_ADDR(i)); | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	default: | 
					
						
							|  |  |  | 		/* Nothing to do */ | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static int rotator_dst_set_transf(struct device *dev, | 
					
						
							|  |  |  | 		enum drm_exynos_degree degree, | 
					
						
							|  |  |  | 		enum drm_exynos_flip flip, bool *swap) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct rot_context *rot = dev_get_drvdata(dev); | 
					
						
							|  |  |  | 	u32 val; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Set transform configuration */ | 
					
						
							|  |  |  | 	val = rot_read(ROT_CONTROL); | 
					
						
							|  |  |  | 	val &= ~ROT_CONTROL_FLIP_MASK; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	switch (flip) { | 
					
						
							|  |  |  | 	case EXYNOS_DRM_FLIP_VERTICAL: | 
					
						
							|  |  |  | 		val |= ROT_CONTROL_FLIP_VERTICAL; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	case EXYNOS_DRM_FLIP_HORIZONTAL: | 
					
						
							|  |  |  | 		val |= ROT_CONTROL_FLIP_HORIZONTAL; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	default: | 
					
						
							|  |  |  | 		/* Flip None */ | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	val &= ~ROT_CONTROL_ROT_MASK; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	switch (degree) { | 
					
						
							|  |  |  | 	case EXYNOS_DRM_DEGREE_90: | 
					
						
							|  |  |  | 		val |= ROT_CONTROL_ROT_90; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	case EXYNOS_DRM_DEGREE_180: | 
					
						
							|  |  |  | 		val |= ROT_CONTROL_ROT_180; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	case EXYNOS_DRM_DEGREE_270: | 
					
						
							|  |  |  | 		val |= ROT_CONTROL_ROT_270; | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	default: | 
					
						
							|  |  |  | 		/* Rotation 0 Degree */ | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	rot_write(val, ROT_CONTROL); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Check degree for setting buffer size swap */ | 
					
						
							|  |  |  | 	if ((degree == EXYNOS_DRM_DEGREE_90) || | 
					
						
							|  |  |  | 	    (degree == EXYNOS_DRM_DEGREE_270)) | 
					
						
							|  |  |  | 		*swap = true; | 
					
						
							|  |  |  | 	else | 
					
						
							|  |  |  | 		*swap = false; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static int rotator_dst_set_size(struct device *dev, int swap, | 
					
						
							|  |  |  | 		struct drm_exynos_pos *pos, | 
					
						
							|  |  |  | 		struct drm_exynos_sz *sz) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct rot_context *rot = dev_get_drvdata(dev); | 
					
						
							|  |  |  | 	u32 val, fmt, hsize, vsize; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Get format */ | 
					
						
							|  |  |  | 	fmt = rotator_reg_get_fmt(rot); | 
					
						
							|  |  |  | 	if (!rotator_check_reg_fmt(fmt)) { | 
					
						
							| 
									
										
										
										
											2013-06-12 10:44:40 +09:00
										 |  |  | 		DRM_ERROR("invalid format.\n"); | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 		return -EINVAL; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Align buffer size */ | 
					
						
							|  |  |  | 	hsize = sz->hsize; | 
					
						
							|  |  |  | 	vsize = sz->vsize; | 
					
						
							|  |  |  | 	rotator_align_size(rot, fmt, &hsize, &vsize); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Set buffer size configuration */ | 
					
						
							|  |  |  | 	val = ROT_SET_BUF_SIZE_H(vsize) | ROT_SET_BUF_SIZE_W(hsize); | 
					
						
							|  |  |  | 	rot_write(val, ROT_DST_BUF_SIZE); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Set crop image position configuration */ | 
					
						
							|  |  |  | 	val = ROT_CROP_POS_Y(pos->y) | ROT_CROP_POS_X(pos->x); | 
					
						
							|  |  |  | 	rot_write(val, ROT_DST_CROP_POS); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static int rotator_dst_set_addr(struct device *dev, | 
					
						
							|  |  |  | 		struct drm_exynos_ipp_buf_info *buf_info, | 
					
						
							|  |  |  | 		u32 buf_id, enum drm_exynos_ipp_buf_type buf_type) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct rot_context *rot = dev_get_drvdata(dev); | 
					
						
							|  |  |  | 	dma_addr_t addr[EXYNOS_DRM_PLANAR_MAX]; | 
					
						
							|  |  |  | 	u32 val, fmt, hsize, vsize; | 
					
						
							|  |  |  | 	int i; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Set current buf_id */ | 
					
						
							|  |  |  | 	rot->cur_buf_id[EXYNOS_DRM_OPS_DST] = buf_id; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	switch (buf_type) { | 
					
						
							|  |  |  | 	case IPP_BUF_ENQUEUE: | 
					
						
							|  |  |  | 		/* Set address configuration */ | 
					
						
							|  |  |  | 		for_each_ipp_planar(i) | 
					
						
							|  |  |  | 			addr[i] = buf_info->base[i]; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		/* Get format */ | 
					
						
							|  |  |  | 		fmt = rotator_reg_get_fmt(rot); | 
					
						
							|  |  |  | 		if (!rotator_check_reg_fmt(fmt)) { | 
					
						
							| 
									
										
										
										
											2013-06-12 10:44:40 +09:00
										 |  |  | 			DRM_ERROR("invalid format.\n"); | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 			return -EINVAL; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		/* Re-set cb planar for NV12 format */ | 
					
						
							|  |  |  | 		if ((fmt == ROT_CONTROL_FMT_YCBCR420_2P) && | 
					
						
							|  |  |  | 		    !addr[EXYNOS_DRM_PLANAR_CB]) { | 
					
						
							|  |  |  | 			/* Get buf size */ | 
					
						
							|  |  |  | 			val = rot_read(ROT_DST_BUF_SIZE); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 			hsize = ROT_GET_BUF_SIZE_W(val); | 
					
						
							|  |  |  | 			vsize = ROT_GET_BUF_SIZE_H(val); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 			/* Set cb planar */ | 
					
						
							|  |  |  | 			addr[EXYNOS_DRM_PLANAR_CB] = | 
					
						
							|  |  |  | 				addr[EXYNOS_DRM_PLANAR_Y] + hsize * vsize; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		for_each_ipp_planar(i) | 
					
						
							|  |  |  | 			rot_write(addr[i], ROT_DST_BUF_ADDR(i)); | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	case IPP_BUF_DEQUEUE: | 
					
						
							|  |  |  | 		for_each_ipp_planar(i) | 
					
						
							|  |  |  | 			rot_write(0x0, ROT_DST_BUF_ADDR(i)); | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	default: | 
					
						
							|  |  |  | 		/* Nothing to do */ | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static struct exynos_drm_ipp_ops rot_src_ops = { | 
					
						
							|  |  |  | 	.set_fmt	=	rotator_src_set_fmt, | 
					
						
							|  |  |  | 	.set_size	=	rotator_src_set_size, | 
					
						
							|  |  |  | 	.set_addr	=	rotator_src_set_addr, | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static struct exynos_drm_ipp_ops rot_dst_ops = { | 
					
						
							|  |  |  | 	.set_transf	=	rotator_dst_set_transf, | 
					
						
							|  |  |  | 	.set_size	=	rotator_dst_set_size, | 
					
						
							|  |  |  | 	.set_addr	=	rotator_dst_set_addr, | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static int rotator_init_prop_list(struct exynos_drm_ippdrv *ippdrv) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2014-05-19 12:54:05 +02:00
										 |  |  | 	struct drm_exynos_ipp_prop_list *prop_list = &ippdrv->prop_list; | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	prop_list->version = 1; | 
					
						
							|  |  |  | 	prop_list->flip = (1 << EXYNOS_DRM_FLIP_VERTICAL) | | 
					
						
							|  |  |  | 				(1 << EXYNOS_DRM_FLIP_HORIZONTAL); | 
					
						
							|  |  |  | 	prop_list->degree = (1 << EXYNOS_DRM_DEGREE_0) | | 
					
						
							|  |  |  | 				(1 << EXYNOS_DRM_DEGREE_90) | | 
					
						
							|  |  |  | 				(1 << EXYNOS_DRM_DEGREE_180) | | 
					
						
							|  |  |  | 				(1 << EXYNOS_DRM_DEGREE_270); | 
					
						
							|  |  |  | 	prop_list->csc = 0; | 
					
						
							|  |  |  | 	prop_list->crop = 0; | 
					
						
							|  |  |  | 	prop_list->scale = 0; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static inline bool rotator_check_drm_fmt(u32 fmt) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	switch (fmt) { | 
					
						
							|  |  |  | 	case DRM_FORMAT_XRGB8888: | 
					
						
							|  |  |  | 	case DRM_FORMAT_NV12: | 
					
						
							|  |  |  | 		return true; | 
					
						
							|  |  |  | 	default: | 
					
						
							| 
									
										
										
										
											2013-06-12 10:44:40 +09:00
										 |  |  | 		DRM_DEBUG_KMS("not support format\n"); | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 		return false; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static inline bool rotator_check_drm_flip(enum drm_exynos_flip flip) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	switch (flip) { | 
					
						
							|  |  |  | 	case EXYNOS_DRM_FLIP_NONE: | 
					
						
							|  |  |  | 	case EXYNOS_DRM_FLIP_VERTICAL: | 
					
						
							|  |  |  | 	case EXYNOS_DRM_FLIP_HORIZONTAL: | 
					
						
							| 
									
										
										
										
											2012-12-22 17:49:24 +09:00
										 |  |  | 	case EXYNOS_DRM_FLIP_BOTH: | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 		return true; | 
					
						
							|  |  |  | 	default: | 
					
						
							| 
									
										
										
										
											2013-06-12 10:44:40 +09:00
										 |  |  | 		DRM_DEBUG_KMS("invalid flip\n"); | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 		return false; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static int rotator_ippdrv_check_property(struct device *dev, | 
					
						
							|  |  |  | 		struct drm_exynos_ipp_property *property) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct drm_exynos_ipp_config *src_config = | 
					
						
							|  |  |  | 					&property->config[EXYNOS_DRM_OPS_SRC]; | 
					
						
							|  |  |  | 	struct drm_exynos_ipp_config *dst_config = | 
					
						
							|  |  |  | 					&property->config[EXYNOS_DRM_OPS_DST]; | 
					
						
							|  |  |  | 	struct drm_exynos_pos *src_pos = &src_config->pos; | 
					
						
							|  |  |  | 	struct drm_exynos_pos *dst_pos = &dst_config->pos; | 
					
						
							|  |  |  | 	struct drm_exynos_sz *src_sz = &src_config->sz; | 
					
						
							|  |  |  | 	struct drm_exynos_sz *dst_sz = &dst_config->sz; | 
					
						
							|  |  |  | 	bool swap = false; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Check format configuration */ | 
					
						
							|  |  |  | 	if (src_config->fmt != dst_config->fmt) { | 
					
						
							| 
									
										
										
										
											2013-06-12 10:44:40 +09:00
										 |  |  | 		DRM_DEBUG_KMS("not support csc feature\n"); | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 		return -EINVAL; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (!rotator_check_drm_fmt(dst_config->fmt)) { | 
					
						
							| 
									
										
										
										
											2013-06-12 10:44:40 +09:00
										 |  |  | 		DRM_DEBUG_KMS("invalid format\n"); | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 		return -EINVAL; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Check transform configuration */ | 
					
						
							|  |  |  | 	if (src_config->degree != EXYNOS_DRM_DEGREE_0) { | 
					
						
							| 
									
										
										
										
											2013-06-12 10:44:40 +09:00
										 |  |  | 		DRM_DEBUG_KMS("not support source-side rotation\n"); | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 		return -EINVAL; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	switch (dst_config->degree) { | 
					
						
							|  |  |  | 	case EXYNOS_DRM_DEGREE_90: | 
					
						
							|  |  |  | 	case EXYNOS_DRM_DEGREE_270: | 
					
						
							|  |  |  | 		swap = true; | 
					
						
							|  |  |  | 	case EXYNOS_DRM_DEGREE_0: | 
					
						
							|  |  |  | 	case EXYNOS_DRM_DEGREE_180: | 
					
						
							|  |  |  | 		/* No problem */ | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	default: | 
					
						
							| 
									
										
										
										
											2013-06-12 10:44:40 +09:00
										 |  |  | 		DRM_DEBUG_KMS("invalid degree\n"); | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 		return -EINVAL; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (src_config->flip != EXYNOS_DRM_FLIP_NONE) { | 
					
						
							| 
									
										
										
										
											2013-06-12 10:44:40 +09:00
										 |  |  | 		DRM_DEBUG_KMS("not support source-side flip\n"); | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 		return -EINVAL; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (!rotator_check_drm_flip(dst_config->flip)) { | 
					
						
							| 
									
										
										
										
											2013-06-12 10:44:40 +09:00
										 |  |  | 		DRM_DEBUG_KMS("invalid flip\n"); | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 		return -EINVAL; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Check size configuration */ | 
					
						
							|  |  |  | 	if ((src_pos->x + src_pos->w > src_sz->hsize) || | 
					
						
							|  |  |  | 		(src_pos->y + src_pos->h > src_sz->vsize)) { | 
					
						
							| 
									
										
										
										
											2013-06-12 10:44:40 +09:00
										 |  |  | 		DRM_DEBUG_KMS("out of source buffer bound\n"); | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 		return -EINVAL; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (swap) { | 
					
						
							|  |  |  | 		if ((dst_pos->x + dst_pos->h > dst_sz->vsize) || | 
					
						
							|  |  |  | 			(dst_pos->y + dst_pos->w > dst_sz->hsize)) { | 
					
						
							| 
									
										
										
										
											2013-06-12 10:44:40 +09:00
										 |  |  | 			DRM_DEBUG_KMS("out of destination buffer bound\n"); | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 			return -EINVAL; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		if ((src_pos->w != dst_pos->h) || (src_pos->h != dst_pos->w)) { | 
					
						
							| 
									
										
										
										
											2013-06-12 10:44:40 +09:00
										 |  |  | 			DRM_DEBUG_KMS("not support scale feature\n"); | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 			return -EINVAL; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 	} else { | 
					
						
							|  |  |  | 		if ((dst_pos->x + dst_pos->w > dst_sz->hsize) || | 
					
						
							|  |  |  | 			(dst_pos->y + dst_pos->h > dst_sz->vsize)) { | 
					
						
							| 
									
										
										
										
											2013-06-12 10:44:40 +09:00
										 |  |  | 			DRM_DEBUG_KMS("out of destination buffer bound\n"); | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 			return -EINVAL; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		if ((src_pos->w != dst_pos->w) || (src_pos->h != dst_pos->h)) { | 
					
						
							| 
									
										
										
										
											2013-06-12 10:44:40 +09:00
										 |  |  | 			DRM_DEBUG_KMS("not support scale feature\n"); | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 			return -EINVAL; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static int rotator_ippdrv_start(struct device *dev, enum drm_exynos_ipp_cmd cmd) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct rot_context *rot = dev_get_drvdata(dev); | 
					
						
							|  |  |  | 	u32 val; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (rot->suspended) { | 
					
						
							|  |  |  | 		DRM_ERROR("suspended state\n"); | 
					
						
							|  |  |  | 		return -EPERM; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (cmd != IPP_CMD_M2M) { | 
					
						
							|  |  |  | 		DRM_ERROR("not support cmd: %d\n", cmd); | 
					
						
							|  |  |  | 		return -EINVAL; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Set interrupt enable */ | 
					
						
							|  |  |  | 	rotator_reg_set_irq(rot, true); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	val = rot_read(ROT_CONTROL); | 
					
						
							|  |  |  | 	val |= ROT_CONTROL_START; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	rot_write(val, ROT_CONTROL); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-08-13 14:12:56 +09:00
										 |  |  | static struct rot_limit_table rot_limit_tbl_4210 = { | 
					
						
							|  |  |  | 	.ycbcr420_2p = { | 
					
						
							|  |  |  | 		.min_w = 32, | 
					
						
							|  |  |  | 		.min_h = 32, | 
					
						
							|  |  |  | 		.max_w = SZ_64K, | 
					
						
							|  |  |  | 		.max_h = SZ_64K, | 
					
						
							|  |  |  | 		.align = 3, | 
					
						
							|  |  |  | 	}, | 
					
						
							|  |  |  | 	.rgb888 = { | 
					
						
							|  |  |  | 		.min_w = 8, | 
					
						
							|  |  |  | 		.min_h = 8, | 
					
						
							|  |  |  | 		.max_w = SZ_16K, | 
					
						
							|  |  |  | 		.max_h = SZ_16K, | 
					
						
							|  |  |  | 		.align = 2, | 
					
						
							|  |  |  | 	}, | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static struct rot_limit_table rot_limit_tbl_4x12 = { | 
					
						
							|  |  |  | 	.ycbcr420_2p = { | 
					
						
							|  |  |  | 		.min_w = 32, | 
					
						
							|  |  |  | 		.min_h = 32, | 
					
						
							|  |  |  | 		.max_w = SZ_32K, | 
					
						
							|  |  |  | 		.max_h = SZ_32K, | 
					
						
							|  |  |  | 		.align = 3, | 
					
						
							|  |  |  | 	}, | 
					
						
							|  |  |  | 	.rgb888 = { | 
					
						
							|  |  |  | 		.min_w = 8, | 
					
						
							|  |  |  | 		.min_h = 8, | 
					
						
							|  |  |  | 		.max_w = SZ_8K, | 
					
						
							|  |  |  | 		.max_h = SZ_8K, | 
					
						
							|  |  |  | 		.align = 2, | 
					
						
							|  |  |  | 	}, | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static struct rot_limit_table rot_limit_tbl_5250 = { | 
					
						
							|  |  |  | 	.ycbcr420_2p = { | 
					
						
							|  |  |  | 		.min_w = 32, | 
					
						
							|  |  |  | 		.min_h = 32, | 
					
						
							|  |  |  | 		.max_w = SZ_32K, | 
					
						
							|  |  |  | 		.max_h = SZ_32K, | 
					
						
							|  |  |  | 		.align = 3, | 
					
						
							|  |  |  | 	}, | 
					
						
							|  |  |  | 	.rgb888 = { | 
					
						
							|  |  |  | 		.min_w = 8, | 
					
						
							|  |  |  | 		.min_h = 8, | 
					
						
							|  |  |  | 		.max_w = SZ_8K, | 
					
						
							|  |  |  | 		.max_h = SZ_8K, | 
					
						
							|  |  |  | 		.align = 1, | 
					
						
							|  |  |  | 	}, | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static const struct of_device_id exynos_rotator_match[] = { | 
					
						
							|  |  |  | 	{ | 
					
						
							|  |  |  | 		.compatible = "samsung,exynos4210-rotator", | 
					
						
							|  |  |  | 		.data = &rot_limit_tbl_4210, | 
					
						
							|  |  |  | 	}, | 
					
						
							|  |  |  | 	{ | 
					
						
							|  |  |  | 		.compatible = "samsung,exynos4212-rotator", | 
					
						
							|  |  |  | 		.data = &rot_limit_tbl_4x12, | 
					
						
							|  |  |  | 	}, | 
					
						
							|  |  |  | 	{ | 
					
						
							|  |  |  | 		.compatible = "samsung,exynos5250-rotator", | 
					
						
							|  |  |  | 		.data = &rot_limit_tbl_5250, | 
					
						
							|  |  |  | 	}, | 
					
						
							|  |  |  | 	{}, | 
					
						
							|  |  |  | }; | 
					
						
							| 
									
										
										
										
											2014-07-18 22:36:41 +02:00
										 |  |  | MODULE_DEVICE_TABLE(of, exynos_rotator_match); | 
					
						
							| 
									
										
										
										
											2013-08-13 14:12:56 +09:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2012-12-21 15:09:25 -08:00
										 |  |  | static int rotator_probe(struct platform_device *pdev) | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | { | 
					
						
							|  |  |  | 	struct device *dev = &pdev->dev; | 
					
						
							|  |  |  | 	struct rot_context *rot; | 
					
						
							|  |  |  | 	struct exynos_drm_ippdrv *ippdrv; | 
					
						
							| 
									
										
										
										
											2013-08-13 14:12:56 +09:00
										 |  |  | 	const struct of_device_id *match; | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 	int ret; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-08-13 14:12:56 +09:00
										 |  |  | 	if (!dev->of_node) { | 
					
						
							|  |  |  | 		dev_err(dev, "cannot find of_node.\n"); | 
					
						
							|  |  |  | 		return -ENODEV; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 	rot = devm_kzalloc(dev, sizeof(*rot), GFP_KERNEL); | 
					
						
							| 
									
										
										
										
											2013-08-19 19:04:55 +09:00
										 |  |  | 	if (!rot) | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 		return -ENOMEM; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-08-13 14:12:56 +09:00
										 |  |  | 	match = of_match_node(exynos_rotator_match, dev->of_node); | 
					
						
							|  |  |  | 	if (!match) { | 
					
						
							|  |  |  | 		dev_err(dev, "failed to match node\n"); | 
					
						
							|  |  |  | 		return -ENODEV; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 	rot->limit_tbl = (struct rot_limit_table *)match->data; | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	rot->regs_res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | 
					
						
							| 
									
										
										
										
											2013-01-21 11:09:02 +01:00
										 |  |  | 	rot->regs = devm_ioremap_resource(dev, rot->regs_res); | 
					
						
							|  |  |  | 	if (IS_ERR(rot->regs)) | 
					
						
							|  |  |  | 		return PTR_ERR(rot->regs); | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	rot->irq = platform_get_irq(pdev, 0); | 
					
						
							|  |  |  | 	if (rot->irq < 0) { | 
					
						
							|  |  |  | 		dev_err(dev, "failed to get irq\n"); | 
					
						
							| 
									
										
										
										
											2012-12-24 14:03:46 +05:30
										 |  |  | 		return rot->irq; | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-05-22 21:14:17 +09:00
										 |  |  | 	ret = devm_request_threaded_irq(dev, rot->irq, NULL, | 
					
						
							|  |  |  | 			rotator_irq_handler, IRQF_ONESHOT, "drm_rotator", rot); | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 	if (ret < 0) { | 
					
						
							|  |  |  | 		dev_err(dev, "failed to request irq\n"); | 
					
						
							| 
									
										
										
										
											2012-12-24 14:03:46 +05:30
										 |  |  | 		return ret; | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2012-12-24 14:03:48 +05:30
										 |  |  | 	rot->clock = devm_clk_get(dev, "rotator"); | 
					
						
							| 
									
										
										
										
											2013-03-21 15:33:59 +05:30
										 |  |  | 	if (IS_ERR(rot->clock)) { | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 		dev_err(dev, "failed to get clock\n"); | 
					
						
							| 
									
										
										
										
											2013-05-22 21:14:17 +09:00
										 |  |  | 		return PTR_ERR(rot->clock); | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	pm_runtime_enable(dev); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	ippdrv = &rot->ippdrv; | 
					
						
							|  |  |  | 	ippdrv->dev = dev; | 
					
						
							|  |  |  | 	ippdrv->ops[EXYNOS_DRM_OPS_SRC] = &rot_src_ops; | 
					
						
							|  |  |  | 	ippdrv->ops[EXYNOS_DRM_OPS_DST] = &rot_dst_ops; | 
					
						
							|  |  |  | 	ippdrv->check_property = rotator_ippdrv_check_property; | 
					
						
							|  |  |  | 	ippdrv->start = rotator_ippdrv_start; | 
					
						
							|  |  |  | 	ret = rotator_init_prop_list(ippdrv); | 
					
						
							|  |  |  | 	if (ret < 0) { | 
					
						
							|  |  |  | 		dev_err(dev, "failed to init property list.\n"); | 
					
						
							|  |  |  | 		goto err_ippdrv_register; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-06-12 10:44:40 +09:00
										 |  |  | 	DRM_DEBUG_KMS("ippdrv[0x%x]\n", (int)ippdrv); | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	platform_set_drvdata(pdev, rot); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	ret = exynos_drm_ippdrv_register(ippdrv); | 
					
						
							|  |  |  | 	if (ret < 0) { | 
					
						
							|  |  |  | 		dev_err(dev, "failed to register drm rotator device\n"); | 
					
						
							|  |  |  | 		goto err_ippdrv_register; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	dev_info(dev, "The exynos rotator is probed successfully\n"); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | err_ippdrv_register: | 
					
						
							|  |  |  | 	pm_runtime_disable(dev); | 
					
						
							|  |  |  | 	return ret; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2012-12-21 15:09:25 -08:00
										 |  |  | static int rotator_remove(struct platform_device *pdev) | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | { | 
					
						
							|  |  |  | 	struct device *dev = &pdev->dev; | 
					
						
							|  |  |  | 	struct rot_context *rot = dev_get_drvdata(dev); | 
					
						
							|  |  |  | 	struct exynos_drm_ippdrv *ippdrv = &rot->ippdrv; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	exynos_drm_ippdrv_unregister(ippdrv); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	pm_runtime_disable(dev); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static int rotator_clk_crtl(struct rot_context *rot, bool enable) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	if (enable) { | 
					
						
							|  |  |  | 		clk_enable(rot->clock); | 
					
						
							|  |  |  | 		rot->suspended = false; | 
					
						
							|  |  |  | 	} else { | 
					
						
							|  |  |  | 		clk_disable(rot->clock); | 
					
						
							|  |  |  | 		rot->suspended = true; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #ifdef CONFIG_PM_SLEEP
 | 
					
						
							|  |  |  | static int rotator_suspend(struct device *dev) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct rot_context *rot = dev_get_drvdata(dev); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (pm_runtime_suspended(dev)) | 
					
						
							|  |  |  | 		return 0; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return rotator_clk_crtl(rot, false); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static int rotator_resume(struct device *dev) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct rot_context *rot = dev_get_drvdata(dev); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (!pm_runtime_suspended(dev)) | 
					
						
							|  |  |  | 		return rotator_clk_crtl(rot, true); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | #endif
 | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-12-04 01:04:55 +01:00
										 |  |  | #ifdef CONFIG_PM
 | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | static int rotator_runtime_suspend(struct device *dev) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct rot_context *rot = dev_get_drvdata(dev); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return  rotator_clk_crtl(rot, false); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static int rotator_runtime_resume(struct device *dev) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct rot_context *rot = dev_get_drvdata(dev); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return  rotator_clk_crtl(rot, true); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | #endif
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static const struct dev_pm_ops rotator_pm_ops = { | 
					
						
							|  |  |  | 	SET_SYSTEM_SLEEP_PM_OPS(rotator_suspend, rotator_resume) | 
					
						
							|  |  |  | 	SET_RUNTIME_PM_OPS(rotator_runtime_suspend, rotator_runtime_resume, | 
					
						
							|  |  |  | 									NULL) | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | struct platform_driver rotator_driver = { | 
					
						
							|  |  |  | 	.probe		= rotator_probe, | 
					
						
							| 
									
										
										
										
											2012-12-21 15:09:25 -08:00
										 |  |  | 	.remove		= rotator_remove, | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 	.driver		= { | 
					
						
							|  |  |  | 		.name	= "exynos-rot", | 
					
						
							|  |  |  | 		.owner	= THIS_MODULE, | 
					
						
							|  |  |  | 		.pm	= &rotator_pm_ops, | 
					
						
							| 
									
										
										
										
											2013-08-13 14:12:56 +09:00
										 |  |  | 		.of_match_table = exynos_rotator_match, | 
					
						
							| 
									
										
										
										
											2012-12-14 17:58:56 +09:00
										 |  |  | 	}, | 
					
						
							|  |  |  | }; |