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