]>
Commit | Line | Data |
---|---|---|
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 | ||
19 | #include <video/omapvrfb.h> | |
20 | ||
21 | #include "omap_voutdef.h" | |
22 | #include "omap_voutlib.h" | |
23 | #include "omap_vout_vrfb.h" | |
24 | ||
25 | #define OMAP_DMA_NO_DEVICE 0 | |
26 | ||
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(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 | if (vout->smsshado_virt_addr[j]) { | |
82 | omap_vout_free_buffer(vout->smsshado_virt_addr[j], | |
83 | vout->smsshado_size); | |
84 | vout->smsshado_virt_addr[j] = 0; | |
85 | vout->smsshado_phy_addr[j] = 0; | |
86 | } | |
87 | } | |
88 | } | |
89 | ||
90 | int omap_vout_setup_vrfb_bufs(struct platform_device *pdev, int vid_num, | |
91 | bool static_vrfb_allocation) | |
92 | { | |
93 | int ret = 0, i, j; | |
94 | struct omap_vout_device *vout; | |
95 | struct video_device *vfd; | |
96 | dma_cap_mask_t mask; | |
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 | dma_cap_zero(mask); | |
135 | dma_cap_set(DMA_INTERLEAVE, mask); | |
136 | vout->vrfb_dma_tx.chan = dma_request_chan_by_mask(&mask); | |
137 | if (IS_ERR(vout->vrfb_dma_tx.chan)) { | |
138 | vout->vrfb_dma_tx.req_status = DMA_CHAN_NOT_ALLOTED; | |
139 | } else { | |
140 | size_t xt_size = sizeof(struct dma_interleaved_template) + | |
141 | sizeof(struct data_chunk); | |
142 | ||
143 | vout->vrfb_dma_tx.xt = kzalloc(xt_size, GFP_KERNEL); | |
144 | if (!vout->vrfb_dma_tx.xt) { | |
145 | dma_release_channel(vout->vrfb_dma_tx.chan); | |
146 | vout->vrfb_dma_tx.req_status = DMA_CHAN_NOT_ALLOTED; | |
147 | } | |
148 | } | |
149 | ||
150 | if (vout->vrfb_dma_tx.req_status == DMA_CHAN_NOT_ALLOTED) | |
151 | dev_info(&pdev->dev, | |
152 | ": failed to allocate DMA Channel for video%d\n", | |
153 | vfd->minor); | |
154 | ||
155 | init_waitqueue_head(&vout->vrfb_dma_tx.wait); | |
156 | ||
157 | /* statically allocated the VRFB buffer is done through | |
158 | commands line aruments */ | |
159 | if (static_vrfb_allocation) { | |
160 | if (omap_vout_allocate_vrfb_buffers(vout, &vrfb_num_bufs, -1)) { | |
161 | ret = -ENOMEM; | |
162 | goto release_vrfb_ctx; | |
163 | } | |
164 | vout->vrfb_static_allocation = true; | |
165 | } | |
166 | return 0; | |
167 | ||
168 | release_vrfb_ctx: | |
169 | for (j = 0; j < VRFB_NUM_BUFS; j++) | |
170 | omap_vrfb_release_ctx(&vout->vrfb_context[j]); | |
171 | free_buffers: | |
172 | omap_vout_free_buffers(vout); | |
173 | ||
174 | return ret; | |
175 | } | |
176 | ||
177 | /* | |
178 | * Release the VRFB context once the module exits | |
179 | */ | |
180 | void omap_vout_release_vrfb(struct omap_vout_device *vout) | |
181 | { | |
182 | int i; | |
183 | ||
184 | for (i = 0; i < VRFB_NUM_BUFS; i++) | |
185 | omap_vrfb_release_ctx(&vout->vrfb_context[i]); | |
186 | ||
187 | if (vout->vrfb_dma_tx.req_status == DMA_CHAN_ALLOTED) { | |
188 | vout->vrfb_dma_tx.req_status = DMA_CHAN_NOT_ALLOTED; | |
189 | kfree(vout->vrfb_dma_tx.xt); | |
190 | dmaengine_terminate_sync(vout->vrfb_dma_tx.chan); | |
191 | dma_release_channel(vout->vrfb_dma_tx.chan); | |
192 | } | |
193 | } | |
194 | ||
195 | /* | |
196 | * Allocate the buffers for the VRFB space. Data is copied from V4L2 | |
197 | * buffers to the VRFB buffers using the DMA engine. | |
198 | */ | |
199 | int omap_vout_vrfb_buffer_setup(struct omap_vout_device *vout, | |
200 | unsigned int *count, unsigned int startindex) | |
201 | { | |
202 | int i; | |
203 | bool yuv_mode; | |
204 | ||
205 | if (!is_rotation_enabled(vout)) | |
206 | return 0; | |
207 | ||
208 | /* If rotation is enabled, allocate memory for VRFB space also */ | |
209 | *count = *count > VRFB_NUM_BUFS ? VRFB_NUM_BUFS : *count; | |
210 | ||
211 | /* Allocate the VRFB buffers only if the buffers are not | |
212 | * allocated during init time. | |
213 | */ | |
214 | if (!vout->vrfb_static_allocation) | |
215 | if (omap_vout_allocate_vrfb_buffers(vout, count, startindex)) | |
216 | return -ENOMEM; | |
217 | ||
218 | if (vout->dss_mode == OMAP_DSS_COLOR_YUV2 || | |
219 | vout->dss_mode == OMAP_DSS_COLOR_UYVY) | |
220 | yuv_mode = true; | |
221 | else | |
222 | yuv_mode = false; | |
223 | ||
224 | for (i = 0; i < *count; i++) | |
225 | omap_vrfb_setup(&vout->vrfb_context[i], | |
226 | vout->smsshado_phy_addr[i], vout->pix.width, | |
227 | vout->pix.height, vout->bpp, yuv_mode); | |
228 | ||
229 | return 0; | |
230 | } | |
231 | ||
232 | int omap_vout_prepare_vrfb(struct omap_vout_device *vout, | |
233 | struct videobuf_buffer *vb) | |
234 | { | |
235 | struct dma_async_tx_descriptor *tx; | |
236 | enum dma_ctrl_flags flags; | |
237 | struct dma_chan *chan = vout->vrfb_dma_tx.chan; | |
238 | struct dma_device *dmadev = chan->device; | |
239 | struct dma_interleaved_template *xt = vout->vrfb_dma_tx.xt; | |
240 | dma_cookie_t cookie; | |
241 | enum dma_status status; | |
242 | enum dss_rotation rotation; | |
243 | size_t dst_icg; | |
244 | u32 pixsize; | |
245 | ||
246 | if (!is_rotation_enabled(vout)) | |
247 | return 0; | |
248 | ||
249 | /* If rotation is enabled, copy input buffer into VRFB | |
250 | * memory space using DMA. We are copying input buffer | |
251 | * into VRFB memory space of desired angle and DSS will | |
252 | * read image VRFB memory for 0 degree angle | |
253 | */ | |
254 | ||
255 | pixsize = vout->bpp * vout->vrfb_bpp; | |
256 | dst_icg = ((MAX_PIXELS_PER_LINE * pixsize) - | |
257 | (vout->pix.width * vout->bpp)) + 1; | |
258 | ||
259 | xt->src_start = vout->buf_phy_addr[vb->i]; | |
260 | xt->dst_start = vout->vrfb_context[vb->i].paddr[0]; | |
261 | ||
262 | xt->numf = vout->pix.height; | |
263 | xt->frame_size = 1; | |
264 | xt->sgl[0].size = vout->pix.width * vout->bpp; | |
265 | xt->sgl[0].icg = dst_icg; | |
266 | ||
267 | xt->dir = DMA_MEM_TO_MEM; | |
268 | xt->src_sgl = false; | |
269 | xt->src_inc = true; | |
270 | xt->dst_sgl = true; | |
271 | xt->dst_inc = true; | |
272 | ||
273 | tx = dmadev->device_prep_interleaved_dma(chan, xt, flags); | |
274 | if (tx == NULL) { | |
275 | pr_err("%s: DMA interleaved prep error\n", __func__); | |
276 | return -EINVAL; | |
277 | } | |
278 | ||
279 | tx->callback = omap_vout_vrfb_dma_tx_callback; | |
280 | tx->callback_param = &vout->vrfb_dma_tx; | |
281 | ||
282 | cookie = dmaengine_submit(tx); | |
283 | if (dma_submit_error(cookie)) { | |
284 | pr_err("%s: dmaengine_submit failed (%d)\n", __func__, cookie); | |
285 | return -EINVAL; | |
286 | } | |
287 | ||
288 | vout->vrfb_dma_tx.tx_status = 0; | |
289 | dma_async_issue_pending(chan); | |
290 | ||
291 | wait_event_interruptible_timeout(vout->vrfb_dma_tx.wait, | |
292 | vout->vrfb_dma_tx.tx_status == 1, | |
293 | VRFB_TX_TIMEOUT); | |
294 | ||
295 | status = dma_async_is_tx_complete(chan, cookie, NULL, NULL); | |
296 | ||
297 | if (vout->vrfb_dma_tx.tx_status == 0) { | |
298 | pr_err("%s: Timeout while waiting for DMA\n", __func__); | |
299 | dmaengine_terminate_sync(chan); | |
300 | return -EINVAL; | |
301 | } else if (status != DMA_COMPLETE) { | |
302 | pr_err("%s: DMA completion %s status\n", __func__, | |
303 | status == DMA_ERROR ? "error" : "busy"); | |
304 | dmaengine_terminate_sync(chan); | |
305 | return -EINVAL; | |
306 | } | |
307 | ||
308 | /* Store buffers physical address into an array. Addresses | |
309 | * from this array will be used to configure DSS */ | |
310 | rotation = calc_rotation(vout); | |
311 | vout->queued_buf_addr[vb->i] = (u8 *) | |
312 | vout->vrfb_context[vb->i].paddr[rotation]; | |
313 | return 0; | |
314 | } | |
315 | ||
316 | /* | |
317 | * Calculate the buffer offsets from which the streaming should | |
318 | * start. This offset calculation is mainly required because of | |
319 | * the VRFB 32 pixels alignment with rotation. | |
320 | */ | |
321 | void omap_vout_calculate_vrfb_offset(struct omap_vout_device *vout) | |
322 | { | |
323 | enum dss_rotation rotation; | |
324 | bool mirroring = vout->mirror; | |
325 | struct v4l2_rect *crop = &vout->crop; | |
326 | struct v4l2_pix_format *pix = &vout->pix; | |
327 | int *cropped_offset = &vout->cropped_offset; | |
328 | int vr_ps = 1, ps = 2, temp_ps = 2; | |
329 | int offset = 0, ctop = 0, cleft = 0, line_length = 0; | |
330 | ||
331 | rotation = calc_rotation(vout); | |
332 | ||
333 | if (V4L2_PIX_FMT_YUYV == pix->pixelformat || | |
334 | V4L2_PIX_FMT_UYVY == pix->pixelformat) { | |
335 | if (is_rotation_enabled(vout)) { | |
336 | /* | |
337 | * ps - Actual pixel size for YUYV/UYVY for | |
338 | * VRFB/Mirroring is 4 bytes | |
339 | * vr_ps - Virtually pixel size for YUYV/UYVY is | |
340 | * 2 bytes | |
341 | */ | |
342 | ps = 4; | |
343 | vr_ps = 2; | |
344 | } else { | |
345 | ps = 2; /* otherwise the pixel size is 2 byte */ | |
346 | } | |
347 | } else if (V4L2_PIX_FMT_RGB32 == pix->pixelformat) { | |
348 | ps = 4; | |
349 | } else if (V4L2_PIX_FMT_RGB24 == pix->pixelformat) { | |
350 | ps = 3; | |
351 | } | |
352 | vout->ps = ps; | |
353 | vout->vr_ps = vr_ps; | |
354 | ||
355 | if (is_rotation_enabled(vout)) { | |
356 | line_length = MAX_PIXELS_PER_LINE; | |
357 | ctop = (pix->height - crop->height) - crop->top; | |
358 | cleft = (pix->width - crop->width) - crop->left; | |
359 | } else { | |
360 | line_length = pix->width; | |
361 | } | |
362 | vout->line_length = line_length; | |
363 | switch (rotation) { | |
364 | case dss_rotation_90_degree: | |
365 | offset = vout->vrfb_context[0].yoffset * | |
366 | vout->vrfb_context[0].bytespp; | |
367 | temp_ps = ps / vr_ps; | |
368 | if (!mirroring) { | |
369 | *cropped_offset = offset + line_length * | |
370 | temp_ps * cleft + crop->top * temp_ps; | |
371 | } else { | |
372 | *cropped_offset = offset + line_length * temp_ps * | |
373 | cleft + crop->top * temp_ps + (line_length * | |
374 | ((crop->width / (vr_ps)) - 1) * ps); | |
375 | } | |
376 | break; | |
377 | case dss_rotation_180_degree: | |
378 | offset = ((MAX_PIXELS_PER_LINE * vout->vrfb_context[0].yoffset * | |
379 | vout->vrfb_context[0].bytespp) + | |
380 | (vout->vrfb_context[0].xoffset * | |
381 | vout->vrfb_context[0].bytespp)); | |
382 | if (!mirroring) { | |
383 | *cropped_offset = offset + (line_length * ps * ctop) + | |
384 | (cleft / vr_ps) * ps; | |
385 | ||
386 | } else { | |
387 | *cropped_offset = offset + (line_length * ps * ctop) + | |
388 | (cleft / vr_ps) * ps + (line_length * | |
389 | (crop->height - 1) * ps); | |
390 | } | |
391 | break; | |
392 | case dss_rotation_270_degree: | |
393 | offset = MAX_PIXELS_PER_LINE * vout->vrfb_context[0].xoffset * | |
394 | vout->vrfb_context[0].bytespp; | |
395 | temp_ps = ps / vr_ps; | |
396 | if (!mirroring) { | |
397 | *cropped_offset = offset + line_length * | |
398 | temp_ps * crop->left + ctop * ps; | |
399 | } else { | |
400 | *cropped_offset = offset + line_length * | |
401 | temp_ps * crop->left + ctop * ps + | |
402 | (line_length * ((crop->width / vr_ps) - 1) * | |
403 | ps); | |
404 | } | |
405 | break; | |
406 | case dss_rotation_0_degree: | |
407 | if (!mirroring) { | |
408 | *cropped_offset = (line_length * ps) * | |
409 | crop->top + (crop->left / vr_ps) * ps; | |
410 | } else { | |
411 | *cropped_offset = (line_length * ps) * | |
412 | crop->top + (crop->left / vr_ps) * ps + | |
413 | (line_length * (crop->height - 1) * ps); | |
414 | } | |
415 | break; | |
416 | default: | |
417 | *cropped_offset = (line_length * ps * crop->top) / | |
418 | vr_ps + (crop->left * ps) / vr_ps + | |
419 | ((crop->width / vr_ps) - 1) * ps; | |
420 | break; | |
421 | } | |
422 | } |