[deliverable/linux.git] / drivers / media / platform / omap / omap_vout_vrfb.c

/*
 * omap_vout_vrfb.c
 *
 * Copyright (C) 2010 Texas Instruments.
 *
 * This file is licensed under the terms of the GNU General Public License
 * version 2. This program is licensed "as is" without any warranty of any
 * kind, whether express or implied.
 *
 */

#include <linux/sched.h>
#include <linux/platform_device.h>
#include <linux/videodev2.h>

#include <media/videobuf-dma-contig.h>
#include <media/v4l2-device.h>

#include <linux/omap-dma.h>
#include <video/omapvrfb.h>

#include "omap_voutdef.h"
#include "omap_voutlib.h"

#define OMAP_DMA_NO_DEVICE	0

/*
 * Function for allocating video buffers
 */
static int omap_vout_allocate_vrfb_buffers(struct omap_vout_device *vout,
		unsigned int *count, int startindex)
{
	int i, j;

	for (i = 0; i < *count; i++) {
		if (!vout->smsshado_virt_addr[i]) {
			vout->smsshado_virt_addr[i] =
				omap_vout_alloc_buffer(vout->smsshado_size,
						&vout->smsshado_phy_addr[i]);
		}
		if (!vout->smsshado_virt_addr[i] && startindex != -1) {
			if (V4L2_MEMORY_MMAP == vout->memory && i >= startindex)
				break;
		}
		if (!vout->smsshado_virt_addr[i]) {
			for (j = 0; j < i; j++) {
				omap_vout_free_buffer(
						vout->smsshado_virt_addr[j],
						vout->smsshado_size);
				vout->smsshado_virt_addr[j] = 0;
				vout->smsshado_phy_addr[j] = 0;
			}
			*count = 0;
			return -ENOMEM;
		}
		memset((void *) vout->smsshado_virt_addr[i], 0,
				vout->smsshado_size);
	}
	return 0;
}

/*
 * Wakes up the application once the DMA transfer to VRFB space is completed.
 */
static void omap_vout_vrfb_dma_tx_callback(int lch, u16 ch_status, void *data)
{
	struct vid_vrfb_dma *t = (struct vid_vrfb_dma *) data;

	t->tx_status = 1;
	wake_up_interruptible(&t->wait);
}

/*
 * Free VRFB buffers
 */
void omap_vout_free_vrfb_buffers(struct omap_vout_device *vout)
{
	int j;

	for (j = 0; j < VRFB_NUM_BUFS; j++) {
		omap_vout_free_buffer(vout->smsshado_virt_addr[j],
				vout->smsshado_size);
		vout->smsshado_virt_addr[j] = 0;
		vout->smsshado_phy_addr[j] = 0;
	}
}

int omap_vout_setup_vrfb_bufs(struct platform_device *pdev, int vid_num,
			      bool static_vrfb_allocation)
{
	int ret = 0, i, j;
	struct omap_vout_device *vout;
	struct video_device *vfd;
	int image_width, image_height;
	int vrfb_num_bufs = VRFB_NUM_BUFS;
	struct v4l2_device *v4l2_dev = platform_get_drvdata(pdev);
	struct omap2video_device *vid_dev =
		container_of(v4l2_dev, struct omap2video_device, v4l2_dev);

	vout = vid_dev->vouts[vid_num];
	vfd = vout->vfd;

	for (i = 0; i < VRFB_NUM_BUFS; i++) {
		if (omap_vrfb_request_ctx(&vout->vrfb_context[i])) {
			dev_info(&pdev->dev, ": VRFB allocation failed\n");
			for (j = 0; j < i; j++)
				omap_vrfb_release_ctx(&vout->vrfb_context[j]);
			ret = -ENOMEM;
			goto free_buffers;
		}
	}

	/* Calculate VRFB memory size */
	/* allocate for worst case size */
	image_width = VID_MAX_WIDTH / TILE_SIZE;
	if (VID_MAX_WIDTH % TILE_SIZE)
		image_width++;

	image_width = image_width * TILE_SIZE;
	image_height = VID_MAX_HEIGHT / TILE_SIZE;

	if (VID_MAX_HEIGHT % TILE_SIZE)
		image_height++;

	image_height = image_height * TILE_SIZE;
	vout->smsshado_size = PAGE_ALIGN(image_width * image_height * 2 * 2);

	/*
	 * Request and Initialize DMA, for DMA based VRFB transfer
	 */
	vout->vrfb_dma_tx.dev_id = OMAP_DMA_NO_DEVICE;
	vout->vrfb_dma_tx.dma_ch = -1;
	vout->vrfb_dma_tx.req_status = DMA_CHAN_ALLOTED;
	ret = omap_request_dma(vout->vrfb_dma_tx.dev_id, "VRFB DMA TX",
			omap_vout_vrfb_dma_tx_callback,
			(void *) &vout->vrfb_dma_tx, &vout->vrfb_dma_tx.dma_ch);
	if (ret < 0) {
		vout->vrfb_dma_tx.req_status = DMA_CHAN_NOT_ALLOTED;
		dev_info(&pdev->dev, ": failed to allocate DMA Channel for"
				" video%d\n", vfd->minor);
	}
	init_waitqueue_head(&vout->vrfb_dma_tx.wait);

	/* statically allocated the VRFB buffer is done through
	   commands line aruments */
	if (static_vrfb_allocation) {
		if (omap_vout_allocate_vrfb_buffers(vout, &vrfb_num_bufs, -1)) {
			ret =  -ENOMEM;
			goto release_vrfb_ctx;
		}
		vout->vrfb_static_allocation = true;
	}
	return 0;

release_vrfb_ctx:
	for (j = 0; j < VRFB_NUM_BUFS; j++)
		omap_vrfb_release_ctx(&vout->vrfb_context[j]);
free_buffers:
	omap_vout_free_buffers(vout);

	return ret;
}

/*
 * Release the VRFB context once the module exits
 */
void omap_vout_release_vrfb(struct omap_vout_device *vout)
{
	int i;

	for (i = 0; i < VRFB_NUM_BUFS; i++)
		omap_vrfb_release_ctx(&vout->vrfb_context[i]);

	if (vout->vrfb_dma_tx.req_status == DMA_CHAN_ALLOTED) {
		vout->vrfb_dma_tx.req_status = DMA_CHAN_NOT_ALLOTED;
		omap_free_dma(vout->vrfb_dma_tx.dma_ch);
	}
}

/*
 * Allocate the buffers for the VRFB space.  Data is copied from V4L2
 * buffers to the VRFB buffers using the DMA engine.
 */
int omap_vout_vrfb_buffer_setup(struct omap_vout_device *vout,
			  unsigned int *count, unsigned int startindex)
{
	int i;
	bool yuv_mode;

	if (!is_rotation_enabled(vout))
		return 0;

	/* If rotation is enabled, allocate memory for VRFB space also */
	*count = *count > VRFB_NUM_BUFS ? VRFB_NUM_BUFS : *count;

	/* Allocate the VRFB buffers only if the buffers are not
	 * allocated during init time.
	 */
	if (!vout->vrfb_static_allocation)
		if (omap_vout_allocate_vrfb_buffers(vout, count, startindex))
			return -ENOMEM;

	if (vout->dss_mode == OMAP_DSS_COLOR_YUV2 ||
			vout->dss_mode == OMAP_DSS_COLOR_UYVY)
		yuv_mode = true;
	else
		yuv_mode = false;

	for (i = 0; i < *count; i++)
		omap_vrfb_setup(&vout->vrfb_context[i],
				vout->smsshado_phy_addr[i], vout->pix.width,
				vout->pix.height, vout->bpp, yuv_mode);

	return 0;
}

int omap_vout_prepare_vrfb(struct omap_vout_device *vout,
				struct videobuf_buffer *vb)
{
	dma_addr_t dmabuf;
	struct vid_vrfb_dma *tx;
	enum dss_rotation rotation;
	u32 dest_frame_index = 0, src_element_index = 0;
	u32 dest_element_index = 0, src_frame_index = 0;
	u32 elem_count = 0, frame_count = 0, pixsize = 2;

	if (!is_rotation_enabled(vout))
		return 0;

	dmabuf = vout->buf_phy_addr[vb->i];
	/* If rotation is enabled, copy input buffer into VRFB
	 * memory space using DMA. We are copying input buffer
	 * into VRFB memory space of desired angle and DSS will
	 * read image VRFB memory for 0 degree angle
	 */
	pixsize = vout->bpp * vout->vrfb_bpp;
	/*
	 * DMA transfer in double index mode
	 */

	/* Frame index */
	dest_frame_index = ((MAX_PIXELS_PER_LINE * pixsize) -
			(vout->pix.width * vout->bpp)) + 1;

	/* Source and destination parameters */
	src_element_index = 0;
	src_frame_index = 0;
	dest_element_index = 1;
	/* Number of elements per frame */
	elem_count = vout->pix.width * vout->bpp;
	frame_count = vout->pix.height;
	tx = &vout->vrfb_dma_tx;
	tx->tx_status = 0;
	omap_set_dma_transfer_params(tx->dma_ch, OMAP_DMA_DATA_TYPE_S32,
			(elem_count / 4), frame_count, OMAP_DMA_SYNC_ELEMENT,
			tx->dev_id, 0x0);
	/* src_port required only for OMAP1 */
	omap_set_dma_src_params(tx->dma_ch, 0, OMAP_DMA_AMODE_POST_INC,
			dmabuf, src_element_index, src_frame_index);
	/*set dma source burst mode for VRFB */
	omap_set_dma_src_burst_mode(tx->dma_ch, OMAP_DMA_DATA_BURST_16);
	rotation = calc_rotation(vout);

	/* dest_port required only for OMAP1 */
	omap_set_dma_dest_params(tx->dma_ch, 0, OMAP_DMA_AMODE_DOUBLE_IDX,
			vout->vrfb_context[vb->i].paddr[0], dest_element_index,
			dest_frame_index);
	/*set dma dest burst mode for VRFB */
	omap_set_dma_dest_burst_mode(tx->dma_ch, OMAP_DMA_DATA_BURST_16);
	omap_dma_set_global_params(DMA_DEFAULT_ARB_RATE, 0x20, 0);

	omap_start_dma(tx->dma_ch);
	wait_event_interruptible_timeout(tx->wait, tx->tx_status == 1,
					 VRFB_TX_TIMEOUT);

	if (tx->tx_status == 0) {
		omap_stop_dma(tx->dma_ch);
		return -EINVAL;
	}
	/* Store buffers physical address into an array. Addresses
	 * from this array will be used to configure DSS */
	vout->queued_buf_addr[vb->i] = (u8 *)
		vout->vrfb_context[vb->i].paddr[rotation];
	return 0;
}

/*
 * Calculate the buffer offsets from which the streaming should
 * start. This offset calculation is mainly required because of
 * the VRFB 32 pixels alignment with rotation.
 */
void omap_vout_calculate_vrfb_offset(struct omap_vout_device *vout)
{
	enum dss_rotation rotation;
	bool mirroring = vout->mirror;
	struct v4l2_rect *crop = &vout->crop;
	struct v4l2_pix_format *pix = &vout->pix;
	int *cropped_offset = &vout->cropped_offset;
	int vr_ps = 1, ps = 2, temp_ps = 2;
	int offset = 0, ctop = 0, cleft = 0, line_length = 0;

	rotation = calc_rotation(vout);

	if (V4L2_PIX_FMT_YUYV == pix->pixelformat ||
			V4L2_PIX_FMT_UYVY == pix->pixelformat) {
		if (is_rotation_enabled(vout)) {
			/*
			 * ps    - Actual pixel size for YUYV/UYVY for
			 *         VRFB/Mirroring is 4 bytes
			 * vr_ps - Virtually pixel size for YUYV/UYVY is
			 *         2 bytes
			 */
			ps = 4;
			vr_ps = 2;
		} else {
			ps = 2;	/* otherwise the pixel size is 2 byte */
		}
	} else if (V4L2_PIX_FMT_RGB32 == pix->pixelformat) {
		ps = 4;
	} else if (V4L2_PIX_FMT_RGB24 == pix->pixelformat) {
		ps = 3;
	}
	vout->ps = ps;
	vout->vr_ps = vr_ps;

	if (is_rotation_enabled(vout)) {
		line_length = MAX_PIXELS_PER_LINE;
		ctop = (pix->height - crop->height) - crop->top;
		cleft = (pix->width - crop->width) - crop->left;
	} else {
		line_length = pix->width;
	}
	vout->line_length = line_length;
	switch (rotation) {
	case dss_rotation_90_degree:
		offset = vout->vrfb_context[0].yoffset *
			vout->vrfb_context[0].bytespp;
		temp_ps = ps / vr_ps;
		if (!mirroring) {
			*cropped_offset = offset + line_length *
				temp_ps * cleft + crop->top * temp_ps;
		} else {
			*cropped_offset = offset + line_length * temp_ps *
				cleft + crop->top * temp_ps + (line_length *
				((crop->width / (vr_ps)) - 1) * ps);
		}
		break;
	case dss_rotation_180_degree:
		offset = ((MAX_PIXELS_PER_LINE * vout->vrfb_context[0].yoffset *
			vout->vrfb_context[0].bytespp) +
			(vout->vrfb_context[0].xoffset *
			vout->vrfb_context[0].bytespp));
		if (!mirroring) {
			*cropped_offset = offset + (line_length * ps * ctop) +
				(cleft / vr_ps) * ps;

		} else {
			*cropped_offset = offset + (line_length * ps * ctop) +
				(cleft / vr_ps) * ps + (line_length *
				(crop->height - 1) * ps);
		}
		break;
	case dss_rotation_270_degree:
		offset = MAX_PIXELS_PER_LINE * vout->vrfb_context[0].xoffset *
			vout->vrfb_context[0].bytespp;
		temp_ps = ps / vr_ps;
		if (!mirroring) {
			*cropped_offset = offset + line_length *
			    temp_ps * crop->left + ctop * ps;
		} else {
			*cropped_offset = offset + line_length *
				temp_ps * crop->left + ctop * ps +
				(line_length * ((crop->width / vr_ps) - 1) *
				 ps);
		}
		break;
	case dss_rotation_0_degree:
		if (!mirroring) {
			*cropped_offset = (line_length * ps) *
				crop->top + (crop->left / vr_ps) * ps;
		} else {
			*cropped_offset = (line_length * ps) *
				crop->top + (crop->left / vr_ps) * ps +
				(line_length * (crop->height - 1) * ps);
		}
		break;
	default:
		*cropped_offset = (line_length * ps * crop->top) /
			vr_ps + (crop->left * ps) / vr_ps +
			((crop->width / vr_ps) - 1) * ps;
		break;
	}
}
Commit	Line	Data
445e258f	1	/*
	2	* omap_vout_vrfb.c
	3	*
	4	* Copyright (C) 2010 Texas Instruments.
	5	*
	6	* This file is licensed under the terms of the GNU General Public License
	7	* version 2. This program is licensed "as is" without any warranty of any
	8	* kind, whether express or implied.
	9	*
	10	*/
	11
	12	#include <linux/sched.h>
	13	#include <linux/platform_device.h>
	14	#include <linux/videodev2.h>
	15
	16	#include <media/videobuf-dma-contig.h>
	17	#include <media/v4l2-device.h>
	18
45c3eb7d	19	#include <linux/omap-dma.h>
6a1c9f6d	20	#include <video/omapvrfb.h>
445e258f	21
	22	#include "omap_voutdef.h"
	23	#include "omap_voutlib.h"
	24
8c4cc005 LV	25	#define OMAP_DMA_NO_DEVICE 0
8c4cc005 LV	26
445e258f	27	/*
	28	* Function for allocating video buffers
	29	*/
	30	static int omap_vout_allocate_vrfb_buffers(struct omap_vout_device *vout,
	31	unsigned int *count, int startindex)
	32	{
	33	int i, j;
	34
	35	for (i = 0; i < *count; i++) {
	36	if (!vout->smsshado_virt_addr[i]) {
	37	vout->smsshado_virt_addr[i] =
	38	omap_vout_alloc_buffer(vout->smsshado_size,
	39	&vout->smsshado_phy_addr[i]);
	40	}
	41	if (!vout->smsshado_virt_addr[i] && startindex != -1) {
	42	if (V4L2_MEMORY_MMAP == vout->memory && i >= startindex)
	43	break;
	44	}
	45	if (!vout->smsshado_virt_addr[i]) {
	46	for (j = 0; j < i; j++) {
	47	omap_vout_free_buffer(
	48	vout->smsshado_virt_addr[j],
	49	vout->smsshado_size);
	50	vout->smsshado_virt_addr[j] = 0;
	51	vout->smsshado_phy_addr[j] = 0;
	52	}
	53	*count = 0;
	54	return -ENOMEM;
	55	}
	56	memset((void *) vout->smsshado_virt_addr[i], 0,
	57	vout->smsshado_size);
	58	}
	59	return 0;
	60	}
	61
	62	/*
	63	* Wakes up the application once the DMA transfer to VRFB space is completed.
	64	*/
	65	static void omap_vout_vrfb_dma_tx_callback(int lch, u16 ch_status, void *data)
	66	{
	67	struct vid_vrfb_dma t = (struct vid_vrfb_dma ) data;
	68
	69	t->tx_status = 1;
	70	wake_up_interruptible(&t->wait);
	71	}
	72
	73	/*
	74	* Free VRFB buffers
	75	*/
	76	void omap_vout_free_vrfb_buffers(struct omap_vout_device *vout)
	77	{
	78	int j;
	79
	80	for (j = 0; j < VRFB_NUM_BUFS; j++) {
	81	omap_vout_free_buffer(vout->smsshado_virt_addr[j],
	82	vout->smsshado_size);
	83	vout->smsshado_virt_addr[j] = 0;
	84	vout->smsshado_phy_addr[j] = 0;
	85	}
	86	}
	87
	88	int omap_vout_setup_vrfb_bufs(struct platform_device *pdev, int vid_num,
90ab5ee9	89	bool static_vrfb_allocation)
445e258f	90	{
	91	int ret = 0, i, j;
	92	struct omap_vout_device *vout;
	93	struct video_device *vfd;
	94	int image_width, image_height;
	95	int vrfb_num_bufs = VRFB_NUM_BUFS;
	96	struct v4l2_device *v4l2_dev = platform_get_drvdata(pdev);
	97	struct omap2video_device *vid_dev =
	98	container_of(v4l2_dev, struct omap2video_device, v4l2_dev);
	99
	100	vout = vid_dev->vouts[vid_num];
	101	vfd = vout->vfd;
	102
	103	for (i = 0; i < VRFB_NUM_BUFS; i++) {
	104	if (omap_vrfb_request_ctx(&vout->vrfb_context[i])) {
	105	dev_info(&pdev->dev, ": VRFB allocation failed\n");
	106	for (j = 0; j < i; j++)
	107	omap_vrfb_release_ctx(&vout->vrfb_context[j]);
	108	ret = -ENOMEM;
	109	goto free_buffers;
	110	}
	111	}
	112
	113	/* Calculate VRFB memory size */
	114	/* allocate for worst case size */
	115	image_width = VID_MAX_WIDTH / TILE_SIZE;
	116	if (VID_MAX_WIDTH % TILE_SIZE)
	117	image_width++;
	118
	119	image_width = image_width * TILE_SIZE;
	120	image_height = VID_MAX_HEIGHT / TILE_SIZE;
	121
	122	if (VID_MAX_HEIGHT % TILE_SIZE)
	123	image_height++;
	124
	125	image_height = image_height * TILE_SIZE;
	126	vout->smsshado_size = PAGE_ALIGN(image_width * image_height * 2 * 2);
	127
	128	/*
	129	* Request and Initialize DMA, for DMA based VRFB transfer
	130	*/
	131	vout->vrfb_dma_tx.dev_id = OMAP_DMA_NO_DEVICE;
	132	vout->vrfb_dma_tx.dma_ch = -1;
	133	vout->vrfb_dma_tx.req_status = DMA_CHAN_ALLOTED;
	134	ret = omap_request_dma(vout->vrfb_dma_tx.dev_id, "VRFB DMA TX",
	135	omap_vout_vrfb_dma_tx_callback,
	136	(void *) &vout->vrfb_dma_tx, &vout->vrfb_dma_tx.dma_ch);
	137	if (ret < 0) {
	138	vout->vrfb_dma_tx.req_status = DMA_CHAN_NOT_ALLOTED;
	139	dev_info(&pdev->dev, ": failed to allocate DMA Channel for"
	140	" video%d\n", vfd->minor);
	141	}
	142	init_waitqueue_head(&vout->vrfb_dma_tx.wait);
	143
	144	/* statically allocated the VRFB buffer is done through
	145	commands line aruments */
	146	if (static_vrfb_allocation) {
	147	if (omap_vout_allocate_vrfb_buffers(vout, &vrfb_num_bufs, -1)) {
	148	ret = -ENOMEM;
	149	goto release_vrfb_ctx;
	150	}
160ac0ba	151	vout->vrfb_static_allocation = true;
445e258f	152	}
	153	return 0;
	154
	155	release_vrfb_ctx:
	156	for (j = 0; j < VRFB_NUM_BUFS; j++)
	157	omap_vrfb_release_ctx(&vout->vrfb_context[j]);
	158	free_buffers:
	159	omap_vout_free_buffers(vout);
	160
	161	return ret;
	162	}
	163
	164	/*
	165	* Release the VRFB context once the module exits
	166	*/
	167	void omap_vout_release_vrfb(struct omap_vout_device *vout)
	168	{
	169	int i;
	170
	171	for (i = 0; i < VRFB_NUM_BUFS; i++)
	172	omap_vrfb_release_ctx(&vout->vrfb_context[i]);
	173
	174	if (vout->vrfb_dma_tx.req_status == DMA_CHAN_ALLOTED) {
	175	vout->vrfb_dma_tx.req_status = DMA_CHAN_NOT_ALLOTED;
	176	omap_free_dma(vout->vrfb_dma_tx.dma_ch);
	177	}
	178	}
	179
	180	/*
	181	* Allocate the buffers for the VRFB space. Data is copied from V4L2
	182	* buffers to the VRFB buffers using the DMA engine.
	183	*/
	184	int omap_vout_vrfb_buffer_setup(struct omap_vout_device *vout,
	185	unsigned int *count, unsigned int startindex)
	186	{
	187	int i;
	188	bool yuv_mode;
	189
	190	if (!is_rotation_enabled(vout))
	191	return 0;
	192
	193	/* If rotation is enabled, allocate memory for VRFB space also */
	194	count = count > VRFB_NUM_BUFS ? VRFB_NUM_BUFS : *count;
	195
	196	/* Allocate the VRFB buffers only if the buffers are not
	197	* allocated during init time.
	198	*/
	199	if (!vout->vrfb_static_allocation)
	200	if (omap_vout_allocate_vrfb_buffers(vout, count, startindex))
	201	return -ENOMEM;
	202
	203	if (vout->dss_mode == OMAP_DSS_COLOR_YUV2 \|\|
	204	vout->dss_mode == OMAP_DSS_COLOR_UYVY)
	205	yuv_mode = true;
	206	else
	207	yuv_mode = false;
	208
	209	for (i = 0; i < *count; i++)
	210	omap_vrfb_setup(&vout->vrfb_context[i],
	211	vout->smsshado_phy_addr[i], vout->pix.width,
	212	vout->pix.height, vout->bpp, yuv_mode);
	213
	214	return 0;
	215	}
216
217	int omap_vout_prepare_vrfb(struct omap_vout_device *vout,
218	struct videobuf_buffer *vb)
219	{
220	dma_addr_t dmabuf;
221	struct vid_vrfb_dma *tx;
222	enum dss_rotation rotation;
223	u32 dest_frame_index = 0, src_element_index = 0;
224	u32 dest_element_index = 0, src_frame_index = 0;
225	u32 elem_count = 0, frame_count = 0, pixsize = 2;
226
227	if (!is_rotation_enabled(vout))
228	return 0;
229
230	dmabuf = vout->buf_phy_addr[vb->i];
231	/* If rotation is enabled, copy input buffer into VRFB
232	* memory space using DMA. We are copying input buffer
233	* into VRFB memory space of desired angle and DSS will
234	* read image VRFB memory for 0 degree angle
235	*/
236	pixsize = vout->bpp * vout->vrfb_bpp;
237	/*
238	* DMA transfer in double index mode
239	*/
240
241	/* Frame index */
242	dest_frame_index = ((MAX_PIXELS_PER_LINE * pixsize) -
243	(vout->pix.width * vout->bpp)) + 1;
244
245	/* Source and destination parameters */
246	src_element_index = 0;
247	src_frame_index = 0;
248	dest_element_index = 1;
249	/* Number of elements per frame */
250	elem_count = vout->pix.width * vout->bpp;
251	frame_count = vout->pix.height;
252	tx = &vout->vrfb_dma_tx;
253	tx->tx_status = 0;
254	omap_set_dma_transfer_params(tx->dma_ch, OMAP_DMA_DATA_TYPE_S32,
255	(elem_count / 4), frame_count, OMAP_DMA_SYNC_ELEMENT,
256	tx->dev_id, 0x0);
257	/* src_port required only for OMAP1 */
258	omap_set_dma_src_params(tx->dma_ch, 0, OMAP_DMA_AMODE_POST_INC,
259	dmabuf, src_element_index, src_frame_index);
260	/set dma source burst mode for VRFB /
261	omap_set_dma_src_burst_mode(tx->dma_ch, OMAP_DMA_DATA_BURST_16);
262	rotation = calc_rotation(vout);
263
264	/* dest_port required only for OMAP1 */
265	omap_set_dma_dest_params(tx->dma_ch, 0, OMAP_DMA_AMODE_DOUBLE_IDX,
266	vout->vrfb_context[vb->i].paddr[0], dest_element_index,
267	dest_frame_index);
268	/set dma dest burst mode for VRFB /
269	omap_set_dma_dest_burst_mode(tx->dma_ch, OMAP_DMA_DATA_BURST_16);
270	omap_dma_set_global_params(DMA_DEFAULT_ARB_RATE, 0x20, 0);
271
272	omap_start_dma(tx->dma_ch);
6a859e09 AB	273	wait_event_interruptible_timeout(tx->wait, tx->tx_status == 1,
6a859e09 AB	274	VRFB_TX_TIMEOUT);
445e258f	275
	276	if (tx->tx_status == 0) {
	277	omap_stop_dma(tx->dma_ch);
	278	return -EINVAL;
	279	}
	280	/* Store buffers physical address into an array. Addresses
	281	* from this array will be used to configure DSS */
	282	vout->queued_buf_addr[vb->i] = (u8 *)
	283	vout->vrfb_context[vb->i].paddr[rotation];
	284	return 0;
	285	}
	286
	287	/*
	288	* Calculate the buffer offsets from which the streaming should
	289	* start. This offset calculation is mainly required because of
	290	* the VRFB 32 pixels alignment with rotation.
	291	*/
	292	void omap_vout_calculate_vrfb_offset(struct omap_vout_device *vout)
	293	{
	294	enum dss_rotation rotation;
	295	bool mirroring = vout->mirror;
	296	struct v4l2_rect *crop = &vout->crop;
	297	struct v4l2_pix_format *pix = &vout->pix;
	298	int *cropped_offset = &vout->cropped_offset;
	299	int vr_ps = 1, ps = 2, temp_ps = 2;
	300	int offset = 0, ctop = 0, cleft = 0, line_length = 0;
	301
	302	rotation = calc_rotation(vout);
	303
	304	if (V4L2_PIX_FMT_YUYV == pix->pixelformat \|\|
	305	V4L2_PIX_FMT_UYVY == pix->pixelformat) {
	306	if (is_rotation_enabled(vout)) {
	307	/*
	308	* ps - Actual pixel size for YUYV/UYVY for
	309	* VRFB/Mirroring is 4 bytes
	310	* vr_ps - Virtually pixel size for YUYV/UYVY is
	311	* 2 bytes
	312	*/
	313	ps = 4;
	314	vr_ps = 2;
	315	} else {
	316	ps = 2; /* otherwise the pixel size is 2 byte */
	317	}
	318	} else if (V4L2_PIX_FMT_RGB32 == pix->pixelformat) {
	319	ps = 4;
	320	} else if (V4L2_PIX_FMT_RGB24 == pix->pixelformat) {
	321	ps = 3;
	322	}
	323	vout->ps = ps;
	324	vout->vr_ps = vr_ps;
	325
	326	if (is_rotation_enabled(vout)) {
	327	line_length = MAX_PIXELS_PER_LINE;
	328	ctop = (pix->height - crop->height) - crop->top;
	329	cleft = (pix->width - crop->width) - crop->left;
	330	} else {
	331	line_length = pix->width;
	332	}
	333	vout->line_length = line_length;
	334	switch (rotation) {
	335	case dss_rotation_90_degree:
	336	offset = vout->vrfb_context[0].yoffset *
	337	vout->vrfb_context[0].bytespp;
	338	temp_ps = ps / vr_ps;
160ac0ba	339	if (!mirroring) {
445e258f	340	cropped_offset = offset + line_length
	341	temp_ps * cleft + crop->top * temp_ps;
	342	} else {
	343	cropped_offset = offset + line_length temp_ps *
	344	cleft + crop->top * temp_ps + (line_length *
	345	((crop->width / (vr_ps)) - 1) * ps);
	346	}
	347	break;
	348	case dss_rotation_180_degree:
	349	offset = ((MAX_PIXELS_PER_LINE * vout->vrfb_context[0].yoffset *
	350	vout->vrfb_context[0].bytespp) +
	351	(vout->vrfb_context[0].xoffset *
	352	vout->vrfb_context[0].bytespp));
160ac0ba	353	if (!mirroring) {
445e258f	354	cropped_offset = offset + (line_length ps * ctop) +
	355	(cleft / vr_ps) * ps;
	356
	357	} else {
	358	cropped_offset = offset + (line_length ps * ctop) +
	359	(cleft / vr_ps) * ps + (line_length *
	360	(crop->height - 1) * ps);
	361	}
	362	break;
	363	case dss_rotation_270_degree:
	364	offset = MAX_PIXELS_PER_LINE * vout->vrfb_context[0].xoffset *
	365	vout->vrfb_context[0].bytespp;
	366	temp_ps = ps / vr_ps;
160ac0ba	367	if (!mirroring) {
445e258f	368	cropped_offset = offset + line_length
	369	temp_ps * crop->left + ctop * ps;
	370	} else {
	371	cropped_offset = offset + line_length
	372	temp_ps * crop->left + ctop * ps +
	373	(line_length * ((crop->width / vr_ps) - 1) *
	374	ps);
	375	}
	376	break;
	377	case dss_rotation_0_degree:
160ac0ba	378	if (!mirroring) {
445e258f	379	cropped_offset = (line_length ps) *
	380	crop->top + (crop->left / vr_ps) * ps;
	381	} else {
	382	cropped_offset = (line_length ps) *
	383	crop->top + (crop->left / vr_ps) * ps +
	384	(line_length * (crop->height - 1) * ps);
	385	}
	386	break;
	387	default:
	388	cropped_offset = (line_length ps * crop->top) /
	389	vr_ps + (crop->left * ps) / vr_ps +
	390	((crop->width / vr_ps) - 1) * ps;
	391	break;
	392	}
	393	}