]> git.proxmox.com Git - mirror_ubuntu-hirsute-kernel.git/blame - drivers/media/platform/s3c-camif/camif-capture.c
projects / mirror_ubuntu-hirsute-kernel.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
[media] media: videobuf2: Restructure vb2_buffer
[mirror_ubuntu-hirsute-kernel.git] / drivers / media / platform / s3c-camif / camif-capture.c
CommitLineData
babde1c2
SN		 1/*
2 * s3c24xx/s3c64xx SoC series Camera Interface (CAMIF) driver
3 *
4 * Copyright (C) 2012 Sylwester Nawrocki <sylvester.nawrocki@gmail.com>
5 * Copyright (C) 2012 Tomasz Figa <tomasz.figa@gmail.com>
6 *
7 * Based on drivers/media/platform/s5p-fimc,
8 * Copyright (C) 2010 - 2012 Samsung Electronics Co., Ltd.
9 *
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License version 2 as
12 * published by the Free Software Foundation.
13*/
14#define pr_fmt(fmt) "%s:%d " fmt, __func__, __LINE__
15
16#include <linux/bug.h>
17#include <linux/clk.h>
18#include <linux/device.h>
19#include <linux/errno.h>
20#include <linux/i2c.h>
21#include <linux/interrupt.h>
22#include <linux/io.h>
23#include <linux/kernel.h>
24#include <linux/list.h>
25#include <linux/module.h>
26#include <linux/platform_device.h>
27#include <linux/pm_runtime.h>
28#include <linux/ratelimit.h>
29#include <linux/slab.h>
30#include <linux/types.h>
31#include <linux/videodev2.h>
32
33#include <media/media-device.h>
34#include <media/v4l2-ctrls.h>
35#include <media/v4l2-event.h>
36#include <media/v4l2-ioctl.h>
c139990e 37#include <media/videobuf2-v4l2.h>
babde1c2
SN		 38#include <media/videobuf2-dma-contig.h>
39
40#include "camif-core.h"
41#include "camif-regs.h"
42
43static int debug;
44module_param(debug, int, 0644);
45
46/* Locking: called with vp->camif->slock spinlock held */
47static void camif_cfg_video_path(struct camif_vp *vp)
48{
49 WARN_ON(s3c_camif_get_scaler_config(vp, &vp->scaler));
50 camif_hw_set_scaler(vp);
51 camif_hw_set_flip(vp);
52 camif_hw_set_target_format(vp);
53 camif_hw_set_output_dma(vp);
54}
55
56static void camif_prepare_dma_offset(struct camif_vp *vp)
57{
58 struct camif_frame *f = &vp->out_frame;
59
60 f->dma_offset.initial = f->rect.top * f->f_width + f->rect.left;
61 f->dma_offset.line = f->f_width - (f->rect.left + f->rect.width);
62
63 pr_debug("dma_offset: initial: %d, line: %d\n",
64 f->dma_offset.initial, f->dma_offset.line);
65}
66
67/* Locking: called with camif->slock spinlock held */
68static int s3c_camif_hw_init(struct camif_dev *camif, struct camif_vp *vp)
69{
70 const struct s3c_camif_variant *variant = camif->variant;
71
72 if (camif->sensor.sd == NULL || vp->out_fmt == NULL)
73 return -EINVAL;
74
75 if (variant->ip_revision == S3C244X_CAMIF_IP_REV)
76 camif_hw_clear_fifo_overflow(vp);
77 camif_hw_set_camera_bus(camif);
78 camif_hw_set_source_format(camif);
79 camif_hw_set_camera_crop(camif);
80 camif_hw_set_test_pattern(camif, camif->test_pattern);
81 if (variant->has_img_effect)
82 camif_hw_set_effect(camif, camif->colorfx,
83 camif->colorfx_cb, camif->colorfx_cr);
84 if (variant->ip_revision == S3C6410_CAMIF_IP_REV)
85 camif_hw_set_input_path(vp);
86 camif_cfg_video_path(vp);
87 vp->state &= ~ST_VP_CONFIG;
88
89 return 0;
90}
91
92/*
93 * Initialize the video path, only up from the scaler stage. The camera
94 * input interface set up is skipped. This is useful to enable one of the
95 * video paths when the other is already running.
96 * Locking: called with camif->slock spinlock held.
97 */
98static int s3c_camif_hw_vp_init(struct camif_dev *camif, struct camif_vp *vp)
99{
100 unsigned int ip_rev = camif->variant->ip_revision;
101
102 if (vp->out_fmt == NULL)
103 return -EINVAL;
104
105 camif_prepare_dma_offset(vp);
106 if (ip_rev == S3C244X_CAMIF_IP_REV)
107 camif_hw_clear_fifo_overflow(vp);
108 camif_cfg_video_path(vp);
109 vp->state &= ~ST_VP_CONFIG;
110 return 0;
111}
112
113static int sensor_set_power(struct camif_dev *camif, int on)
114{
115 struct cam_sensor *sensor = &camif->sensor;
116 int err = 0;
117
7e0d4e92 118 if (camif->sensor.power_count == !on)
babde1c2
SN		 119 err = v4l2_subdev_call(sensor->sd, core, s_power, on);
120 if (!err)
121 sensor->power_count += on ? 1 : -1;
122
123 pr_debug("on: %d, power_count: %d, err: %d\n",
124 on, sensor->power_count, err);
125
126 return err;
127}
128
129static int sensor_set_streaming(struct camif_dev *camif, int on)
130{
131 struct cam_sensor *sensor = &camif->sensor;
132 int err = 0;
133
7e0d4e92 134 if (camif->sensor.stream_count == !on)
babde1c2
SN		 135 err = v4l2_subdev_call(sensor->sd, video, s_stream, on);
136 if (!err)
137 sensor->stream_count += on ? 1 : -1;
138
139 pr_debug("on: %d, stream_count: %d, err: %d\n",
140 on, sensor->stream_count, err);
141
142 return err;
143}
144
145/*
146 * Reinitialize the driver so it is ready to start streaming again.
147 * Return any buffers to vb2, perform CAMIF software reset and
148 * turn off streaming at the data pipeline (sensor) if required.
149 */
150static int camif_reinitialize(struct camif_vp *vp)
151{
152 struct camif_dev *camif = vp->camif;
153 struct camif_buffer *buf;
154 unsigned long flags;
155 bool streaming;
156
157 spin_lock_irqsave(&camif->slock, flags);
158 streaming = vp->state & ST_VP_SENSOR_STREAMING;
159
160 vp->state &= ~(ST_VP_PENDING | ST_VP_RUNNING | ST_VP_OFF |
161 ST_VP_ABORTING | ST_VP_STREAMING |
162 ST_VP_SENSOR_STREAMING | ST_VP_LASTIRQ);
163
164 /* Release unused buffers */
165 while (!list_empty(&vp->pending_buf_q)) {
166 buf = camif_pending_queue_pop(vp);
2d700715 167 vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_ERROR);
babde1c2
SN		 168 }
169
170 while (!list_empty(&vp->active_buf_q)) {
171 buf = camif_active_queue_pop(vp);
2d700715 172 vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_ERROR);
babde1c2
SN		 173 }
174
175 spin_unlock_irqrestore(&camif->slock, flags);
176
177 if (!streaming)
178 return 0;
179
180 return sensor_set_streaming(camif, 0);
181}
182
183static bool s3c_vp_active(struct camif_vp *vp)
184{
185 struct camif_dev *camif = vp->camif;
186 unsigned long flags;
187 bool ret;
188
189 spin_lock_irqsave(&camif->slock, flags);
190 ret = (vp->state & ST_VP_RUNNING) || (vp->state & ST_VP_PENDING);
191 spin_unlock_irqrestore(&camif->slock, flags);
192
193 return ret;
194}
195
196static bool camif_is_streaming(struct camif_dev *camif)
197{
198 unsigned long flags;
199 bool status;
200
201 spin_lock_irqsave(&camif->slock, flags);
202 status = camif->stream_count > 0;
203 spin_unlock_irqrestore(&camif->slock, flags);
204
205 return status;
206}
207
208static int camif_stop_capture(struct camif_vp *vp)
209{
210 struct camif_dev *camif = vp->camif;
211 unsigned long flags;
212 int ret;
213
214 if (!s3c_vp_active(vp))
215 return 0;
216
217 spin_lock_irqsave(&camif->slock, flags);
218 vp->state &= ~(ST_VP_OFF | ST_VP_LASTIRQ);
219 vp->state |= ST_VP_ABORTING;
220 spin_unlock_irqrestore(&camif->slock, flags);
221
222 ret = wait_event_timeout(vp->irq_queue,
223 !(vp->state & ST_VP_ABORTING),
224 msecs_to_jiffies(CAMIF_STOP_TIMEOUT));
225
226 spin_lock_irqsave(&camif->slock, flags);
227
228 if (ret == 0 && !(vp->state & ST_VP_OFF)) {
229 /* Timed out, forcibly stop capture */
230 vp->state &= ~(ST_VP_OFF | ST_VP_ABORTING |
231 ST_VP_LASTIRQ);
232
233 camif_hw_disable_capture(vp);
234 camif_hw_enable_scaler(vp, false);
235 }
236
237 spin_unlock_irqrestore(&camif->slock, flags);
238
239 return camif_reinitialize(vp);
240}
241
242static int camif_prepare_addr(struct camif_vp *vp, struct vb2_buffer *vb,
243 struct camif_addr *paddr)
244{
245 struct camif_frame *frame = &vp->out_frame;
246 u32 pix_size;
247
248 if (vb == NULL || frame == NULL)
249 return -EINVAL;
250
251 pix_size = frame->rect.width * frame->rect.height;
252
253 pr_debug("colplanes: %d, pix_size: %u\n",
254 vp->out_fmt->colplanes, pix_size);
255
256 paddr->y = vb2_dma_contig_plane_dma_addr(vb, 0);
257
258 switch (vp->out_fmt->colplanes) {
259 case 1:
260 paddr->cb = 0;
261 paddr->cr = 0;
262 break;
263 case 2:
264 /* decompose Y into Y/Cb */
265 paddr->cb = (u32)(paddr->y + pix_size);
266 paddr->cr = 0;
267 break;
268 case 3:
269 paddr->cb = (u32)(paddr->y + pix_size);
270 /* decompose Y into Y/Cb/Cr */
271 if (vp->out_fmt->color == IMG_FMT_YCBCR422P)
272 paddr->cr = (u32)(paddr->cb + (pix_size >> 1));
273 else /* 420 */
274 paddr->cr = (u32)(paddr->cb + (pix_size >> 2));
275
276 if (vp->out_fmt->color == IMG_FMT_YCRCB420)
277 swap(paddr->cb, paddr->cr);
278 break;
279 default:
280 return -EINVAL;
281 }
282
c0a566f3
MCC		 283 pr_debug("DMA address: y: %pad cb: %pad cr: %pad\n",
284 &paddr->y, &paddr->cb, &paddr->cr);
babde1c2
SN		 285
286 return 0;
287}
288
289irqreturn_t s3c_camif_irq_handler(int irq, void *priv)
290{
291 struct camif_vp *vp = priv;
292 struct camif_dev *camif = vp->camif;
293 unsigned int ip_rev = camif->variant->ip_revision;
294 unsigned int status;
295
296 spin_lock(&camif->slock);
297
298 if (ip_rev == S3C6410_CAMIF_IP_REV)
299 camif_hw_clear_pending_irq(vp);
300
301 status = camif_hw_get_status(vp);
302
303 if (ip_rev == S3C244X_CAMIF_IP_REV && (status & CISTATUS_OVF_MASK)) {
304 camif_hw_clear_fifo_overflow(vp);
305 goto unlock;
306 }
307
308 if (vp->state & ST_VP_ABORTING) {
309 if (vp->state & ST_VP_OFF) {
310 /* Last IRQ */
311 vp->state &= ~(ST_VP_OFF | ST_VP_ABORTING |
312 ST_VP_LASTIRQ);
313 wake_up(&vp->irq_queue);
314 goto unlock;
315 } else if (vp->state & ST_VP_LASTIRQ) {
316 camif_hw_disable_capture(vp);
317 camif_hw_enable_scaler(vp, false);
318 camif_hw_set_lastirq(vp, false);
319 vp->state |= ST_VP_OFF;
320 } else {
321 /* Disable capture, enable last IRQ */
322 camif_hw_set_lastirq(vp, true);
323 vp->state |= ST_VP_LASTIRQ;
324 }
325 }
326
327 if (!list_empty(&vp->pending_buf_q) && (vp->state & ST_VP_RUNNING) &&
328 !list_empty(&vp->active_buf_q)) {
329 unsigned int index;
330 struct camif_buffer *vbuf;
babde1c2
SN		 331 /*
332 * Get previous DMA write buffer index:
333 * 0 => DMA buffer 0, 2;
334 * 1 => DMA buffer 1, 3.
335 */
336 index = (CISTATUS_FRAMECNT(status) + 2) & 1;
babde1c2
SN		 337 vbuf = camif_active_queue_peek(vp, index);
338
339 if (!WARN_ON(vbuf == NULL)) {
340 /* Dequeue a filled buffer */
2d700715
JS		 341 v4l2_get_timestamp(&vbuf->vb.timestamp);
342 vbuf->vb.sequence = vp->frame_sequence++;
343 vb2_buffer_done(&vbuf->vb.vb2_buf, VB2_BUF_STATE_DONE);
babde1c2
SN		 344
345 /* Set up an empty buffer at the DMA engine */
346 vbuf = camif_pending_queue_pop(vp);
347 vbuf->index = index;
348 camif_hw_set_output_addr(vp, &vbuf->paddr, index);
349 camif_hw_set_output_addr(vp, &vbuf->paddr, index + 2);
350
351 /* Scheduled in H/W, add to the queue */
352 camif_active_queue_add(vp, vbuf);
353 }
354 } else if (!(vp->state & ST_VP_ABORTING) &&
355 (vp->state & ST_VP_PENDING)) {
356 vp->state |= ST_VP_RUNNING;
357 }
358
359 if (vp->state & ST_VP_CONFIG) {
360 camif_prepare_dma_offset(vp);
361 camif_hw_set_camera_crop(camif);
362 camif_hw_set_scaler(vp);
363 camif_hw_set_flip(vp);
364 camif_hw_set_test_pattern(camif, camif->test_pattern);
365 if (camif->variant->has_img_effect)
366 camif_hw_set_effect(camif, camif->colorfx,
367 camif->colorfx_cb, camif->colorfx_cr);
368 vp->state &= ~ST_VP_CONFIG;
369 }
370unlock:
371 spin_unlock(&camif->slock);
372 return IRQ_HANDLED;
373}
374
375static int start_streaming(struct vb2_queue *vq, unsigned int count)
376{
377 struct camif_vp *vp = vb2_get_drv_priv(vq);
378 struct camif_dev *camif = vp->camif;
379 unsigned long flags;
380 int ret;
381
382 /*
383 * We assume the codec capture path is always activated
384 * first, before the preview path starts streaming.
385 * This is required to avoid internal FIFO overflow and
386 * a need for CAMIF software reset.
387 */
388 spin_lock_irqsave(&camif->slock, flags);
389
390 if (camif->stream_count == 0) {
391 camif_hw_reset(camif);
392 ret = s3c_camif_hw_init(camif, vp);
393 } else {
394 ret = s3c_camif_hw_vp_init(camif, vp);
395 }
396 spin_unlock_irqrestore(&camif->slock, flags);
397
398 if (ret < 0) {
399 camif_reinitialize(vp);
400 return ret;
401 }
402
403 spin_lock_irqsave(&camif->slock, flags);
404 vp->frame_sequence = 0;
405 vp->state |= ST_VP_PENDING;
406
407 if (!list_empty(&vp->pending_buf_q) &&
408 (!(vp->state & ST_VP_STREAMING) ||
409 !(vp->state & ST_VP_SENSOR_STREAMING))) {
410
411 camif_hw_enable_scaler(vp, vp->scaler.enable);
412 camif_hw_enable_capture(vp);
413 vp->state |= ST_VP_STREAMING;
414
415 if (!(vp->state & ST_VP_SENSOR_STREAMING)) {
416 vp->state |= ST_VP_SENSOR_STREAMING;
417 spin_unlock_irqrestore(&camif->slock, flags);
418 ret = sensor_set_streaming(camif, 1);
419 if (ret)
420 v4l2_err(&vp->vdev, "Sensor s_stream failed\n");
421 if (debug)
422 camif_hw_dump_regs(camif, __func__);
423
424 return ret;
425 }
426 }
427
428 spin_unlock_irqrestore(&camif->slock, flags);
429 return 0;
430}
431
e37559b2 432static void stop_streaming(struct vb2_queue *vq)
babde1c2
SN		 433{
434 struct camif_vp *vp = vb2_get_drv_priv(vq);
e37559b2 435 camif_stop_capture(vp);
babde1c2
SN		 436}
437
438static int queue_setup(struct vb2_queue *vq, const struct v4l2_format *pfmt,
439 unsigned int *num_buffers, unsigned int *num_planes,
440 unsigned int sizes[], void *allocators[])
441{
442 const struct v4l2_pix_format *pix = NULL;
443 struct camif_vp *vp = vb2_get_drv_priv(vq);
444 struct camif_dev *camif = vp->camif;
445 struct camif_frame *frame = &vp->out_frame;
b4bb1bd7 446 const struct camif_fmt *fmt;
babde1c2
SN		 447 unsigned int size;
448
449 if (pfmt) {
450 pix = &pfmt->fmt.pix;
451 fmt = s3c_camif_find_format(vp, &pix->pixelformat, -1);
b4bb1bd7
MCC		 452 if (fmt == NULL)
453 return -EINVAL;
babde1c2
SN		 454 size = (pix->width * pix->height * fmt->depth) / 8;
455 } else {
b4bb1bd7
MCC		 456 fmt = vp->out_fmt;
457 if (fmt == NULL)
458 return -EINVAL;
babde1c2
SN		 459 size = (frame->f_width * frame->f_height * fmt->depth) / 8;
460 }
461
babde1c2
SN		 462 *num_planes = 1;
463
464 if (pix)
465 sizes[0] = max(size, pix->sizeimage);
466 else
467 sizes[0] = size;
468 allocators[0] = camif->alloc_ctx;
469
470 pr_debug("size: %u\n", sizes[0]);
471 return 0;
472}
473
474static int buffer_prepare(struct vb2_buffer *vb)
475{
476 struct camif_vp *vp = vb2_get_drv_priv(vb->vb2_queue);
477
478 if (vp->out_fmt == NULL)
479 return -EINVAL;
480
481 if (vb2_plane_size(vb, 0) < vp->payload) {
482 v4l2_err(&vp->vdev, "buffer too small: %lu, required: %u\n",
483 vb2_plane_size(vb, 0), vp->payload);
484 return -EINVAL;
485 }
486 vb2_set_plane_payload(vb, 0, vp->payload);
487
488 return 0;
489}
490
491static void buffer_queue(struct vb2_buffer *vb)
492{
2d700715
JS		 493 struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
494 struct camif_buffer *buf = container_of(vbuf, struct camif_buffer, vb);
babde1c2
SN		 495 struct camif_vp *vp = vb2_get_drv_priv(vb->vb2_queue);
496 struct camif_dev *camif = vp->camif;
497 unsigned long flags;
498
499 spin_lock_irqsave(&camif->slock, flags);
2d700715 500 WARN_ON(camif_prepare_addr(vp, &buf->vb.vb2_buf, &buf->paddr));
babde1c2
SN		 501
502 if (!(vp->state & ST_VP_STREAMING) && vp->active_buffers < 2) {
503 /* Schedule an empty buffer in H/W */
504 buf->index = vp->buf_index;
505
506 camif_hw_set_output_addr(vp, &buf->paddr, buf->index);
507 camif_hw_set_output_addr(vp, &buf->paddr, buf->index + 2);
508
509 camif_active_queue_add(vp, buf);
510 vp->buf_index = !vp->buf_index;
511 } else {
512 camif_pending_queue_add(vp, buf);
513 }
514
515 if (vb2_is_streaming(&vp->vb_queue) && !list_empty(&vp->pending_buf_q)
516 && !(vp->state & ST_VP_STREAMING)) {
517
518 vp->state |= ST_VP_STREAMING;
519 camif_hw_enable_scaler(vp, vp->scaler.enable);
520 camif_hw_enable_capture(vp);
521 spin_unlock_irqrestore(&camif->slock, flags);
522
523 if (!(vp->state & ST_VP_SENSOR_STREAMING)) {
524 if (sensor_set_streaming(camif, 1) == 0)
525 vp->state |= ST_VP_SENSOR_STREAMING;
526 else
527 v4l2_err(&vp->vdev, "Sensor s_stream failed\n");
528
529 if (debug)
530 camif_hw_dump_regs(camif, __func__);
531 }
532 return;
533 }
534 spin_unlock_irqrestore(&camif->slock, flags);
535}
536
babde1c2
SN		 537static const struct vb2_ops s3c_camif_qops = {
538 .queue_setup = queue_setup,
539 .buf_prepare = buffer_prepare,
540 .buf_queue = buffer_queue,
2914e726
PL		 541 .wait_prepare = vb2_ops_wait_prepare,
542 .wait_finish = vb2_ops_wait_finish,
babde1c2
SN		 543 .start_streaming = start_streaming,
544 .stop_streaming = stop_streaming,
545};
546
547static int s3c_camif_open(struct file *file)
548{
549 struct camif_vp *vp = video_drvdata(file);
550 struct camif_dev *camif = vp->camif;
551 int ret;
552
553 pr_debug("[vp%d] state: %#x, owner: %p, pid: %d\n", vp->id,
554 vp->state, vp->owner, task_pid_nr(current));
555
556 if (mutex_lock_interruptible(&camif->lock))
557 return -ERESTARTSYS;
558
559 ret = v4l2_fh_open(file);
560 if (ret < 0)
561 goto unlock;
562
563 ret = pm_runtime_get_sync(camif->dev);
564 if (ret < 0)
565 goto err_pm;
566
567 ret = sensor_set_power(camif, 1);
568 if (!ret)
569 goto unlock;
570
571 pm_runtime_put(camif->dev);
572err_pm:
573 v4l2_fh_release(file);
574unlock:
575 mutex_unlock(&camif->lock);
576 return ret;
577}
578
579static int s3c_camif_close(struct file *file)
580{
581 struct camif_vp *vp = video_drvdata(file);
582 struct camif_dev *camif = vp->camif;
583 int ret;
584
585 pr_debug("[vp%d] state: %#x, owner: %p, pid: %d\n", vp->id,
586 vp->state, vp->owner, task_pid_nr(current));
587
588 mutex_lock(&camif->lock);
589
590 if (vp->owner == file->private_data) {
591 camif_stop_capture(vp);
592 vb2_queue_release(&vp->vb_queue);
593 vp->owner = NULL;
594 }
595
596 sensor_set_power(camif, 0);
597
598 pm_runtime_put(camif->dev);
599 ret = v4l2_fh_release(file);
600
601 mutex_unlock(&camif->lock);
602 return ret;
603}
604
605static unsigned int s3c_camif_poll(struct file *file,
606 struct poll_table_struct *wait)
607{
608 struct camif_vp *vp = video_drvdata(file);
609 struct camif_dev *camif = vp->camif;
610 int ret;
611
612 mutex_lock(&camif->lock);
613 if (vp->owner && vp->owner != file->private_data)
614 ret = -EBUSY;
615 else
616 ret = vb2_poll(&vp->vb_queue, file, wait);
617
618 mutex_unlock(&camif->lock);
619 return ret;
620}
621
622static int s3c_camif_mmap(struct file *file, struct vm_area_struct *vma)
623{
624 struct camif_vp *vp = video_drvdata(file);
625 int ret;
626
627 if (vp->owner && vp->owner != file->private_data)
628 ret = -EBUSY;
629 else
630 ret = vb2_mmap(&vp->vb_queue, vma);
631
632 return ret;
633}
634
635static const struct v4l2_file_operations s3c_camif_fops = {
636 .owner = THIS_MODULE,
637 .open = s3c_camif_open,
638 .release = s3c_camif_close,
639 .poll = s3c_camif_poll,
640 .unlocked_ioctl = video_ioctl2,
641 .mmap = s3c_camif_mmap,
642};
643
644/*
645 * Video node IOCTLs
646 */
647
648static int s3c_camif_vidioc_querycap(struct file *file, void *priv,
649 struct v4l2_capability *cap)
650{
651 struct camif_vp *vp = video_drvdata(file);
652
653 strlcpy(cap->driver, S3C_CAMIF_DRIVER_NAME, sizeof(cap->driver));
654 strlcpy(cap->card, S3C_CAMIF_DRIVER_NAME, sizeof(cap->card));
655 snprintf(cap->bus_info, sizeof(cap->bus_info), "platform:%s.%d",
656 dev_name(vp->camif->dev), vp->id);
657
658 cap->device_caps = V4L2_CAP_STREAMING | V4L2_CAP_VIDEO_CAPTURE;
659 cap->capabilities = cap->device_caps | V4L2_CAP_DEVICE_CAPS;
660
661 return 0;
662}
663
664static int s3c_camif_vidioc_enum_input(struct file *file, void *priv,
665 struct v4l2_input *input)
666{
667 struct camif_vp *vp = video_drvdata(file);
668 struct v4l2_subdev *sensor = vp->camif->sensor.sd;
669
670 if (input->index || sensor == NULL)
671 return -EINVAL;
672
673 input->type = V4L2_INPUT_TYPE_CAMERA;
674 strlcpy(input->name, sensor->name, sizeof(input->name));
675 return 0;
676}
677
678static int s3c_camif_vidioc_s_input(struct file *file, void *priv,
679 unsigned int i)
680{
681 return i == 0 ? 0 : -EINVAL;
682}
683
684static int s3c_camif_vidioc_g_input(struct file *file, void *priv,
685 unsigned int *i)
686{
687 *i = 0;
688 return 0;
689}
690
691static int s3c_camif_vidioc_enum_fmt(struct file *file, void *priv,
692 struct v4l2_fmtdesc *f)
693{
694 struct camif_vp *vp = video_drvdata(file);
695 const struct camif_fmt *fmt;
696
697 fmt = s3c_camif_find_format(vp, NULL, f->index);
698 if (!fmt)
699 return -EINVAL;
700
701 strlcpy(f->description, fmt->name, sizeof(f->description));
702 f->pixelformat = fmt->fourcc;
703
704 pr_debug("fmt(%d): %s\n", f->index, f->description);
705 return 0;
706}
707
708static int s3c_camif_vidioc_g_fmt(struct file *file, void *priv,
709 struct v4l2_format *f)
710{
711 struct camif_vp *vp = video_drvdata(file);
712 struct v4l2_pix_format *pix = &f->fmt.pix;
713 struct camif_frame *frame = &vp->out_frame;
714 const struct camif_fmt *fmt = vp->out_fmt;
715
716 pix->bytesperline = frame->f_width * fmt->ybpp;
717 pix->sizeimage = vp->payload;
718
719 pix->pixelformat = fmt->fourcc;
720 pix->width = frame->f_width;
721 pix->height = frame->f_height;
722 pix->field = V4L2_FIELD_NONE;
723 pix->colorspace = V4L2_COLORSPACE_JPEG;
724
725 return 0;
726}
727
728static int __camif_video_try_format(struct camif_vp *vp,
729 struct v4l2_pix_format *pix,
730 const struct camif_fmt **ffmt)
731{
732 struct camif_dev *camif = vp->camif;
733 struct v4l2_rect *crop = &camif->camif_crop;
734 unsigned int wmin, hmin, sc_hrmax, sc_vrmax;
735 const struct vp_pix_limits *pix_lim;
736 const struct camif_fmt *fmt;
737
738 fmt = s3c_camif_find_format(vp, &pix->pixelformat, 0);
739
740 if (WARN_ON(fmt == NULL))
741 return -EINVAL;
742
743 if (ffmt)
744 *ffmt = fmt;
745
746 pix_lim = &camif->variant->vp_pix_limits[vp->id];
747
748 pr_debug("fmt: %ux%u, crop: %ux%u, bytesperline: %u\n",
749 pix->width, pix->height, crop->width, crop->height,
750 pix->bytesperline);
751 /*
752 * Calculate minimum width and height according to the configured
753 * camera input interface crop rectangle and the resizer's capabilities.
754 */
755 sc_hrmax = min(SCALER_MAX_RATIO, 1 << (ffs(crop->width) - 3));
756 sc_vrmax = min(SCALER_MAX_RATIO, 1 << (ffs(crop->height) - 1));
757
758 wmin = max_t(u32, pix_lim->min_out_width, crop->width / sc_hrmax);
759 wmin = round_up(wmin, pix_lim->out_width_align);
760 hmin = max_t(u32, 8, crop->height / sc_vrmax);
761 hmin = round_up(hmin, 8);
762
763 v4l_bound_align_image(&pix->width, wmin, pix_lim->max_sc_out_width,
764 ffs(pix_lim->out_width_align) - 1,
765 &pix->height, hmin, pix_lim->max_height, 0, 0);
766
767 pix->bytesperline = pix->width * fmt->ybpp;
768 pix->sizeimage = (pix->width * pix->height * fmt->depth) / 8;
769 pix->pixelformat = fmt->fourcc;
770 pix->colorspace = V4L2_COLORSPACE_JPEG;
771 pix->field = V4L2_FIELD_NONE;
772
773 pr_debug("%ux%u, wmin: %d, hmin: %d, sc_hrmax: %d, sc_vrmax: %d\n",
774 pix->width, pix->height, wmin, hmin, sc_hrmax, sc_vrmax);
775
776 return 0;
777}
778
779static int s3c_camif_vidioc_try_fmt(struct file *file, void *priv,
780 struct v4l2_format *f)
781{
782 struct camif_vp *vp = video_drvdata(file);
783 return __camif_video_try_format(vp, &f->fmt.pix, NULL);
784}
785
786static int s3c_camif_vidioc_s_fmt(struct file *file, void *priv,
787 struct v4l2_format *f)
788{
789 struct v4l2_pix_format *pix = &f->fmt.pix;
790 struct camif_vp *vp = video_drvdata(file);
791 struct camif_frame *out_frame = &vp->out_frame;
792 const struct camif_fmt *fmt = NULL;
793 int ret;
794
795 pr_debug("[vp%d]\n", vp->id);
796
797 if (vb2_is_busy(&vp->vb_queue))
798 return -EBUSY;
799
800 ret = __camif_video_try_format(vp, &f->fmt.pix, &fmt);
801 if (ret < 0)
802 return ret;
803
804 vp->out_fmt = fmt;
805 vp->payload = pix->sizeimage;
806 out_frame->f_width = pix->width;
807 out_frame->f_height = pix->height;
808
809 /* Reset composition rectangle */
810 out_frame->rect.width = pix->width;
811 out_frame->rect.height = pix->height;
812 out_frame->rect.left = 0;
813 out_frame->rect.top = 0;
814
815 if (vp->owner == NULL)
816 vp->owner = priv;
817
818 pr_debug("%ux%u. payload: %u. fmt: %s. %d %d. sizeimage: %d. bpl: %d\n",
819 out_frame->f_width, out_frame->f_height, vp->payload, fmt->name,
820 pix->width * pix->height * fmt->depth, fmt->depth,
821 pix->sizeimage, pix->bytesperline);
822
823 return 0;
824}
825
826/* Only check pixel formats at the sensor and the camif subdev pads */
827static int camif_pipeline_validate(struct camif_dev *camif)
828{
829 struct v4l2_subdev_format src_fmt;
830 struct media_pad *pad;
831 int ret;
832
833 /* Retrieve format at the sensor subdev source pad */
1bddf1b3 834 pad = media_entity_remote_pad(&camif->pads[0]);
babde1c2
SN		 835 if (!pad || media_entity_type(pad->entity) != MEDIA_ENT_T_V4L2_SUBDEV)
836 return -EPIPE;
837
838 src_fmt.pad = pad->index;
839 src_fmt.which = V4L2_SUBDEV_FORMAT_ACTIVE;
840 ret = v4l2_subdev_call(camif->sensor.sd, pad, get_fmt, NULL, &src_fmt);
841 if (ret < 0 && ret != -ENOIOCTLCMD)
842 return -EPIPE;
843
844 if (src_fmt.format.width != camif->mbus_fmt.width ||
845 src_fmt.format.height != camif->mbus_fmt.height ||
846 src_fmt.format.code != camif->mbus_fmt.code)
847 return -EPIPE;
848
849 return 0;
850}
851
852static int s3c_camif_streamon(struct file *file, void *priv,
853 enum v4l2_buf_type type)
854{
855 struct camif_vp *vp = video_drvdata(file);
856 struct camif_dev *camif = vp->camif;
857 struct media_entity *sensor = &camif->sensor.sd->entity;
858 int ret;
859
860 pr_debug("[vp%d]\n", vp->id);
861
862 if (type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
863 return -EINVAL;
864
865 if (vp->owner && vp->owner != priv)
866 return -EBUSY;
867
868 if (s3c_vp_active(vp))
869 return 0;
870
871 ret = media_entity_pipeline_start(sensor, camif->m_pipeline);
872 if (ret < 0)
873 return ret;
874
875 ret = camif_pipeline_validate(camif);
876 if (ret < 0) {
877 media_entity_pipeline_stop(sensor);
878 return ret;
879 }
880
881 return vb2_streamon(&vp->vb_queue, type);
882}
883
884static int s3c_camif_streamoff(struct file *file, void *priv,
885 enum v4l2_buf_type type)
886{
887 struct camif_vp *vp = video_drvdata(file);
888 struct camif_dev *camif = vp->camif;
889 int ret;
890
891 pr_debug("[vp%d]\n", vp->id);
892
893 if (type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
894 return -EINVAL;
895
896 if (vp->owner && vp->owner != priv)
897 return -EBUSY;
898
899 ret = vb2_streamoff(&vp->vb_queue, type);
900 if (ret == 0)
901 media_entity_pipeline_stop(&camif->sensor.sd->entity);
902 return ret;
903}
904
905static int s3c_camif_reqbufs(struct file *file, void *priv,
906 struct v4l2_requestbuffers *rb)
907{
908 struct camif_vp *vp = video_drvdata(file);
909 int ret;
910
911 pr_debug("[vp%d] rb count: %d, owner: %p, priv: %p\n",
912 vp->id, rb->count, vp->owner, priv);
913
914 if (vp->owner && vp->owner != priv)
915 return -EBUSY;
916
917 if (rb->count)
918 rb->count = max_t(u32, CAMIF_REQ_BUFS_MIN, rb->count);
919 else
920 vp->owner = NULL;
921
922 ret = vb2_reqbufs(&vp->vb_queue, rb);
69b95a3a
SN		 923 if (ret < 0)
924 return ret;
925
926 if (rb->count && rb->count < CAMIF_REQ_BUFS_MIN) {
927 rb->count = 0;
928 vb2_reqbufs(&vp->vb_queue, rb);
929 ret = -ENOMEM;
babde1c2
SN		 930 }
931
69b95a3a
SN		 932 vp->reqbufs_count = rb->count;
933 if (vp->owner == NULL && rb->count > 0)
934 vp->owner = priv;
935
babde1c2
SN		 936 return ret;
937}
938
939static int s3c_camif_querybuf(struct file *file, void *priv,
940 struct v4l2_buffer *buf)
941{
942 struct camif_vp *vp = video_drvdata(file);
943 return vb2_querybuf(&vp->vb_queue, buf);
944}
945
946static int s3c_camif_qbuf(struct file *file, void *priv,
947 struct v4l2_buffer *buf)
948{
949 struct camif_vp *vp = video_drvdata(file);
950
951 pr_debug("[vp%d]\n", vp->id);
952
953 if (vp->owner && vp->owner != priv)
954 return -EBUSY;
955
956 return vb2_qbuf(&vp->vb_queue, buf);
957}
958
959static int s3c_camif_dqbuf(struct file *file, void *priv,
960 struct v4l2_buffer *buf)
961{
962 struct camif_vp *vp = video_drvdata(file);
963
964 pr_debug("[vp%d] sequence: %d\n", vp->id, vp->frame_sequence);
965
966 if (vp->owner && vp->owner != priv)
967 return -EBUSY;
968
969 return vb2_dqbuf(&vp->vb_queue, buf, file->f_flags & O_NONBLOCK);
970}
971
972static int s3c_camif_create_bufs(struct file *file, void *priv,
973 struct v4l2_create_buffers *create)
974{
975 struct camif_vp *vp = video_drvdata(file);
976 int ret;
977
978 if (vp->owner && vp->owner != priv)
979 return -EBUSY;
980
981 create->count = max_t(u32, 1, create->count);
982 ret = vb2_create_bufs(&vp->vb_queue, create);
983
984 if (!ret && vp->owner == NULL)
985 vp->owner = priv;
986
987 return ret;
988}
989
990static int s3c_camif_prepare_buf(struct file *file, void *priv,
991 struct v4l2_buffer *b)
992{
993 struct camif_vp *vp = video_drvdata(file);
994 return vb2_prepare_buf(&vp->vb_queue, b);
995}
996
997static int s3c_camif_g_selection(struct file *file, void *priv,
998 struct v4l2_selection *sel)
999{
1000 struct camif_vp *vp = video_drvdata(file);
1001
1002 if (sel->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
1003 return -EINVAL;
1004
1005 switch (sel->target) {
1006 case V4L2_SEL_TGT_COMPOSE_BOUNDS:
1007 case V4L2_SEL_TGT_COMPOSE_DEFAULT:
1008 sel->r.left = 0;
1009 sel->r.top = 0;
1010 sel->r.width = vp->out_frame.f_width;
1011 sel->r.height = vp->out_frame.f_height;
1012 return 0;
1013
1014 case V4L2_SEL_TGT_COMPOSE:
1015 sel->r = vp->out_frame.rect;
1016 return 0;
1017 }
1018
1019 return -EINVAL;
1020}
1021
1022static void __camif_try_compose(struct camif_dev *camif, struct camif_vp *vp,
1023 struct v4l2_rect *r)
1024{
1025 /* s3c244x doesn't support composition */
1026 if (camif->variant->ip_revision == S3C244X_CAMIF_IP_REV) {
1027 *r = vp->out_frame.rect;
1028 return;
1029 }
1030
1031 /* TODO: s3c64xx */
1032}
1033
1034static int s3c_camif_s_selection(struct file *file, void *priv,
1035 struct v4l2_selection *sel)
1036{
1037 struct camif_vp *vp = video_drvdata(file);
1038 struct camif_dev *camif = vp->camif;
1039 struct v4l2_rect rect = sel->r;
1040 unsigned long flags;
1041
1042 if (sel->type != V4L2_BUF_TYPE_VIDEO_CAPTURE ||
1043 sel->target != V4L2_SEL_TGT_COMPOSE)
1044 return -EINVAL;
1045
1046 __camif_try_compose(camif, vp, &rect);
1047
1048 sel->r = rect;
1049 spin_lock_irqsave(&camif->slock, flags);
1050 vp->out_frame.rect = rect;
1051 vp->state |= ST_VP_CONFIG;
1052 spin_unlock_irqrestore(&camif->slock, flags);
1053
1054 pr_debug("type: %#x, target: %#x, flags: %#x, (%d,%d)/%dx%d\n",
1055 sel->type, sel->target, sel->flags,
1056 sel->r.left, sel->r.top, sel->r.width, sel->r.height);
1057
1058 return 0;
1059}
1060
1061static const struct v4l2_ioctl_ops s3c_camif_ioctl_ops = {
1062 .vidioc_querycap = s3c_camif_vidioc_querycap,
1063 .vidioc_enum_input = s3c_camif_vidioc_enum_input,
1064 .vidioc_g_input = s3c_camif_vidioc_g_input,
1065 .vidioc_s_input = s3c_camif_vidioc_s_input,
1066 .vidioc_enum_fmt_vid_cap = s3c_camif_vidioc_enum_fmt,
1067 .vidioc_try_fmt_vid_cap = s3c_camif_vidioc_try_fmt,
1068 .vidioc_s_fmt_vid_cap = s3c_camif_vidioc_s_fmt,
1069 .vidioc_g_fmt_vid_cap = s3c_camif_vidioc_g_fmt,
1070 .vidioc_g_selection = s3c_camif_g_selection,
1071 .vidioc_s_selection = s3c_camif_s_selection,
1072 .vidioc_reqbufs = s3c_camif_reqbufs,
1073 .vidioc_querybuf = s3c_camif_querybuf,
1074 .vidioc_prepare_buf = s3c_camif_prepare_buf,
1075 .vidioc_create_bufs = s3c_camif_create_bufs,
1076 .vidioc_qbuf = s3c_camif_qbuf,
1077 .vidioc_dqbuf = s3c_camif_dqbuf,
1078 .vidioc_streamon = s3c_camif_streamon,
1079 .vidioc_streamoff = s3c_camif_streamoff,
1080 .vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
1081 .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
1082 .vidioc_log_status = v4l2_ctrl_log_status,
1083};
1084
1085/*
1086 * Video node controls
1087 */
1088static int s3c_camif_video_s_ctrl(struct v4l2_ctrl *ctrl)
1089{
1090 struct camif_vp *vp = ctrl->priv;
1091 struct camif_dev *camif = vp->camif;
1092 unsigned long flags;
1093
1094 pr_debug("[vp%d] ctrl: %s, value: %d\n", vp->id,
1095 ctrl->name, ctrl->val);
1096
1097 spin_lock_irqsave(&camif->slock, flags);
1098
1099 switch (ctrl->id) {
1100 case V4L2_CID_HFLIP:
1101 vp->hflip = ctrl->val;
1102 break;
1103
1104 case V4L2_CID_VFLIP:
1105 vp->vflip = ctrl->val;
1106 break;
1107 }
1108
1109 vp->state |= ST_VP_CONFIG;
1110 spin_unlock_irqrestore(&camif->slock, flags);
1111 return 0;
1112}
1113
1114/* Codec and preview video node control ops */
1115static const struct v4l2_ctrl_ops s3c_camif_video_ctrl_ops = {
1116 .s_ctrl = s3c_camif_video_s_ctrl,
1117};
1118
1119int s3c_camif_register_video_node(struct camif_dev *camif, int idx)
1120{
1121 struct camif_vp *vp = &camif->vp[idx];
1122 struct vb2_queue *q = &vp->vb_queue;
1123 struct video_device *vfd = &vp->vdev;
1124 struct v4l2_ctrl *ctrl;
1125 int ret;
1126
1127 memset(vfd, 0, sizeof(*vfd));
1128 snprintf(vfd->name, sizeof(vfd->name), "camif-%s",
1129 vp->id == 0 ? "codec" : "preview");
1130
1131 vfd->fops = &s3c_camif_fops;
1132 vfd->ioctl_ops = &s3c_camif_ioctl_ops;
1133 vfd->v4l2_dev = &camif->v4l2_dev;
1134 vfd->minor = -1;
1135 vfd->release = video_device_release_empty;
1136 vfd->lock = &camif->lock;
1137 vp->reqbufs_count = 0;
1138
1139 INIT_LIST_HEAD(&vp->pending_buf_q);
1140 INIT_LIST_HEAD(&vp->active_buf_q);
1141
1142 memset(q, 0, sizeof(*q));
1143 q->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
1144 q->io_modes = VB2_MMAP | VB2_USERPTR;
1145 q->ops = &s3c_camif_qops;
1146 q->mem_ops = &vb2_dma_contig_memops;
1147 q->buf_struct_size = sizeof(struct camif_buffer);
1148 q->drv_priv = vp;
ade48681 1149 q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC;
2914e726 1150 q->lock = &vp->camif->lock;
babde1c2
SN		 1151
1152 ret = vb2_queue_init(q);
1153 if (ret)
1154 goto err_vd_rel;
1155
1156 vp->pad.flags = MEDIA_PAD_FL_SINK;
1157 ret = media_entity_init(&vfd->entity, 1, &vp->pad, 0);
1158 if (ret)
1159 goto err_vd_rel;
1160
1161 video_set_drvdata(vfd, vp);
babde1c2
SN		 1162
1163 v4l2_ctrl_handler_init(&vp->ctrl_handler, 1);
1164 ctrl = v4l2_ctrl_new_std(&vp->ctrl_handler, &s3c_camif_video_ctrl_ops,
1165 V4L2_CID_HFLIP, 0, 1, 1, 0);
1166 if (ctrl)
1167 ctrl->priv = vp;
1168 ctrl = v4l2_ctrl_new_std(&vp->ctrl_handler, &s3c_camif_video_ctrl_ops,
1169 V4L2_CID_VFLIP, 0, 1, 1, 0);
1170 if (ctrl)
1171 ctrl->priv = vp;
1172
1173 ret = vp->ctrl_handler.error;
1174 if (ret < 0)
1175 goto err_me_cleanup;
1176
1177 vfd->ctrl_handler = &vp->ctrl_handler;
1178
1179 ret = video_register_device(vfd, VFL_TYPE_GRABBER, -1);
1180 if (ret)
1181 goto err_ctrlh_free;
1182
1183 v4l2_info(&camif->v4l2_dev, "registered %s as /dev/%s\n",
1184 vfd->name, video_device_node_name(vfd));
1185 return 0;
1186
1187err_ctrlh_free:
1188 v4l2_ctrl_handler_free(&vp->ctrl_handler);
1189err_me_cleanup:
1190 media_entity_cleanup(&vfd->entity);
1191err_vd_rel:
1192 video_device_release(vfd);
1193 return ret;
1194}
1195
1196void s3c_camif_unregister_video_node(struct camif_dev *camif, int idx)
1197{
1198 struct video_device *vfd = &camif->vp[idx].vdev;
1199
1200 if (video_is_registered(vfd)) {
1201 video_unregister_device(vfd);
1202 media_entity_cleanup(&vfd->entity);
1203 v4l2_ctrl_handler_free(vfd->ctrl_handler);
1204 }
1205}
1206
1207/* Media bus pixel formats supported at the camif input */
27ffaeb0
BB		 1208static const u32 camif_mbus_formats[] = {
1209 MEDIA_BUS_FMT_YUYV8_2X8,
1210 MEDIA_BUS_FMT_YVYU8_2X8,
1211 MEDIA_BUS_FMT_UYVY8_2X8,
1212 MEDIA_BUS_FMT_VYUY8_2X8,
babde1c2
SN		 1213};
1214
1215/*
1216 * Camera input interface subdev operations
1217 */
1218
1219static int s3c_camif_subdev_enum_mbus_code(struct v4l2_subdev *sd,
f7234138 1220 struct v4l2_subdev_pad_config *cfg,
babde1c2
SN		 1221 struct v4l2_subdev_mbus_code_enum *code)
1222{
1223 if (code->index >= ARRAY_SIZE(camif_mbus_formats))
1224 return -EINVAL;
1225
1226 code->code = camif_mbus_formats[code->index];
1227 return 0;
1228}
1229
1230static int s3c_camif_subdev_get_fmt(struct v4l2_subdev *sd,
f7234138 1231 struct v4l2_subdev_pad_config *cfg,
babde1c2
SN		 1232 struct v4l2_subdev_format *fmt)
1233{
1234 struct camif_dev *camif = v4l2_get_subdevdata(sd);
1235 struct v4l2_mbus_framefmt *mf = &fmt->format;
1236
1237 if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) {
f7234138 1238 mf = v4l2_subdev_get_try_format(sd, cfg, fmt->pad);
babde1c2
SN		 1239 fmt->format = *mf;
1240 return 0;
1241 }
1242
1243 mutex_lock(&camif->lock);
1244
1245 switch (fmt->pad) {
1246 case CAMIF_SD_PAD_SINK:
1247 /* full camera input pixel size */
1248 *mf = camif->mbus_fmt;
1249 break;
1250
1251 case CAMIF_SD_PAD_SOURCE_C...CAMIF_SD_PAD_SOURCE_P:
1252 /* crop rectangle at camera interface input */
1253 mf->width = camif->camif_crop.width;
1254 mf->height = camif->camif_crop.height;
1255 mf->code = camif->mbus_fmt.code;
1256 break;
1257 }
1258
1259 mutex_unlock(&camif->lock);
6c5bba9b 1260 mf->field = V4L2_FIELD_NONE;
babde1c2
SN		 1261 mf->colorspace = V4L2_COLORSPACE_JPEG;
1262 return 0;
1263}
1264
1265static void __camif_subdev_try_format(struct camif_dev *camif,
1266 struct v4l2_mbus_framefmt *mf, int pad)
1267{
1268 const struct s3c_camif_variant *variant = camif->variant;
1269 const struct vp_pix_limits *pix_lim;
1270 int i = ARRAY_SIZE(camif_mbus_formats);
1271
1272 /* FIXME: constraints against codec or preview path ? */
1273 pix_lim = &variant->vp_pix_limits[VP_CODEC];
1274
1275 while (i-- >= 0)
1276 if (camif_mbus_formats[i] == mf->code)
1277 break;
1278
1279 mf->code = camif_mbus_formats[i];
1280
1281 if (pad == CAMIF_SD_PAD_SINK) {
1282 v4l_bound_align_image(&mf->width, 8, CAMIF_MAX_PIX_WIDTH,
1283 ffs(pix_lim->out_width_align) - 1,
1284 &mf->height, 8, CAMIF_MAX_PIX_HEIGHT, 0,
1285 0);
1286 } else {
1287 struct v4l2_rect *crop = &camif->camif_crop;
1288 v4l_bound_align_image(&mf->width, 8, crop->width,
1289 ffs(pix_lim->out_width_align) - 1,
1290 &mf->height, 8, crop->height,
1291 0, 0);
1292 }
1293
1294 v4l2_dbg(1, debug, &camif->subdev, "%ux%u\n", mf->width, mf->height);
1295}
1296
1297static int s3c_camif_subdev_set_fmt(struct v4l2_subdev *sd,
f7234138 1298 struct v4l2_subdev_pad_config *cfg,
babde1c2
SN		 1299 struct v4l2_subdev_format *fmt)
1300{
1301 struct camif_dev *camif = v4l2_get_subdevdata(sd);
1302 struct v4l2_mbus_framefmt *mf = &fmt->format;
1303 struct v4l2_rect *crop = &camif->camif_crop;
1304 int i;
1305
1306 v4l2_dbg(1, debug, sd, "pad%d: code: 0x%x, %ux%u\n",
1307 fmt->pad, mf->code, mf->width, mf->height);
1308
6c5bba9b 1309 mf->field = V4L2_FIELD_NONE;
babde1c2
SN		 1310 mf->colorspace = V4L2_COLORSPACE_JPEG;
1311 mutex_lock(&camif->lock);
1312
1313 /*
1314 * No pixel format change at the camera input is allowed
1315 * while streaming.
1316 */
1317 if (vb2_is_busy(&camif->vp[VP_CODEC].vb_queue) ||
1318 vb2_is_busy(&camif->vp[VP_PREVIEW].vb_queue)) {
1319 mutex_unlock(&camif->lock);
1320 return -EBUSY;
1321 }
1322
1323 __camif_subdev_try_format(camif, mf, fmt->pad);
1324
1325 if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) {
f7234138 1326 mf = v4l2_subdev_get_try_format(sd, cfg, fmt->pad);
babde1c2
SN		 1327 *mf = fmt->format;
1328 mutex_unlock(&camif->lock);
1329 return 0;
1330 }
1331
1332 switch (fmt->pad) {
1333 case CAMIF_SD_PAD_SINK:
1334 camif->mbus_fmt = *mf;
1335 /* Reset sink crop rectangle. */
1336 crop->width = mf->width;
1337 crop->height = mf->height;
1338 crop->left = 0;
1339 crop->top = 0;
1340 /*
1341 * Reset source format (the camif's crop rectangle)
1342 * and the video output resolution.
1343 */
1344 for (i = 0; i < CAMIF_VP_NUM; i++) {
1345 struct camif_frame *frame = &camif->vp[i].out_frame;
1346 frame->rect = *crop;
1347 frame->f_width = mf->width;
1348 frame->f_height = mf->height;
1349 }
1350 break;
1351
1352 case CAMIF_SD_PAD_SOURCE_C...CAMIF_SD_PAD_SOURCE_P:
1353 /* Pixel format can be only changed on the sink pad. */
1354 mf->code = camif->mbus_fmt.code;
1355 mf->width = crop->width;
1356 mf->height = crop->height;
1357 break;
1358 }
1359
1360 mutex_unlock(&camif->lock);
1361 return 0;
1362}
1363
1364static int s3c_camif_subdev_get_selection(struct v4l2_subdev *sd,
f7234138 1365 struct v4l2_subdev_pad_config *cfg,
babde1c2
SN		 1366 struct v4l2_subdev_selection *sel)
1367{
1368 struct camif_dev *camif = v4l2_get_subdevdata(sd);
1369 struct v4l2_rect *crop = &camif->camif_crop;
1370 struct v4l2_mbus_framefmt *mf = &camif->mbus_fmt;
1371
1372 if ((sel->target != V4L2_SEL_TGT_CROP &&
1373 sel->target != V4L2_SEL_TGT_CROP_BOUNDS) ||
1374 sel->pad != CAMIF_SD_PAD_SINK)
1375 return -EINVAL;
1376
1377 if (sel->which == V4L2_SUBDEV_FORMAT_TRY) {
f7234138 1378 sel->r = *v4l2_subdev_get_try_crop(sd, cfg, sel->pad);
babde1c2
SN		 1379 return 0;
1380 }
1381
1382 mutex_lock(&camif->lock);
1383
1384 if (sel->target == V4L2_SEL_TGT_CROP) {
1385 sel->r = *crop;
1386 } else { /* crop bounds */
1387 sel->r.width = mf->width;
1388 sel->r.height = mf->height;
1389 sel->r.left = 0;
1390 sel->r.top = 0;
1391 }
1392
1393 mutex_unlock(&camif->lock);
1394
1395 v4l2_dbg(1, debug, sd, "%s: crop: (%d,%d) %dx%d, size: %ux%u\n",
1396 __func__, crop->left, crop->top, crop->width,
1397 crop->height, mf->width, mf->height);
1398
1399 return 0;
1400}
1401
1402static void __camif_try_crop(struct camif_dev *camif, struct v4l2_rect *r)
1403{
1404 struct v4l2_mbus_framefmt *mf = &camif->mbus_fmt;
1405 const struct camif_pix_limits *pix_lim = &camif->variant->pix_limits;
1406 unsigned int left = 2 * r->left;
1407 unsigned int top = 2 * r->top;
1408
1409 /*
1410 * Following constraints must be met:
1411 * - r->width + 2 * r->left = mf->width;
1412 * - r->height + 2 * r->top = mf->height;
1413 * - crop rectangle size and position must be aligned
1414 * to 8 or 2 pixels, depending on SoC version.
1415 */
1416 v4l_bound_align_image(&r->width, 0, mf->width,
1417 ffs(pix_lim->win_hor_offset_align) - 1,
1418 &r->height, 0, mf->height, 1, 0);
1419
1420 v4l_bound_align_image(&left, 0, mf->width - r->width,
1421 ffs(pix_lim->win_hor_offset_align),
1422 &top, 0, mf->height - r->height, 2, 0);
1423
1424 r->left = left / 2;
1425 r->top = top / 2;
1426 r->width = mf->width - left;
1427 r->height = mf->height - top;
1428 /*
1429 * Make sure we either downscale or upscale both the pixel
1430 * width and height. Just return current crop rectangle if
1431 * this scaler constraint is not met.
1432 */
1433 if (camif->variant->ip_revision == S3C244X_CAMIF_IP_REV &&
1434 camif_is_streaming(camif)) {
1435 unsigned int i;
1436
1437 for (i = 0; i < CAMIF_VP_NUM; i++) {
1438 struct v4l2_rect *or = &camif->vp[i].out_frame.rect;
1439 if ((or->width > r->width) == (or->height > r->height))
1440 continue;
1441 *r = camif->camif_crop;
1442 pr_debug("Width/height scaling direction limitation\n");
1443 break;
1444 }
1445 }
1446
1447 v4l2_dbg(1, debug, &camif->v4l2_dev, "crop: (%d,%d)/%dx%d, fmt: %ux%u\n",
1448 r->left, r->top, r->width, r->height, mf->width, mf->height);
1449}
1450
1451static int s3c_camif_subdev_set_selection(struct v4l2_subdev *sd,
f7234138 1452 struct v4l2_subdev_pad_config *cfg,
babde1c2
SN		 1453 struct v4l2_subdev_selection *sel)
1454{
1455 struct camif_dev *camif = v4l2_get_subdevdata(sd);
1456 struct v4l2_rect *crop = &camif->camif_crop;
1457 struct camif_scaler scaler;
1458
1459 if (sel->target != V4L2_SEL_TGT_CROP || sel->pad != CAMIF_SD_PAD_SINK)
1460 return -EINVAL;
1461
1462 mutex_lock(&camif->lock);
1463 __camif_try_crop(camif, &sel->r);
1464
1465 if (sel->which == V4L2_SUBDEV_FORMAT_TRY) {
f7234138 1466 *v4l2_subdev_get_try_crop(sd, cfg, sel->pad) = sel->r;
babde1c2
SN		 1467 } else {
1468 unsigned long flags;
1469 unsigned int i;
1470
1471 spin_lock_irqsave(&camif->slock, flags);
1472 *crop = sel->r;
1473
1474 for (i = 0; i < CAMIF_VP_NUM; i++) {
1475 struct camif_vp *vp = &camif->vp[i];
1476 scaler = vp->scaler;
1477 if (s3c_camif_get_scaler_config(vp, &scaler))
1478 continue;
1479 vp->scaler = scaler;
1480 vp->state |= ST_VP_CONFIG;
1481 }
1482
1483 spin_unlock_irqrestore(&camif->slock, flags);
1484 }
1485 mutex_unlock(&camif->lock);
1486
1487 v4l2_dbg(1, debug, sd, "%s: (%d,%d) %dx%d, f_w: %u, f_h: %u\n",
1488 __func__, crop->left, crop->top, crop->width, crop->height,
1489 camif->mbus_fmt.width, camif->mbus_fmt.height);
1490
1491 return 0;
1492}
1493
1494static const struct v4l2_subdev_pad_ops s3c_camif_subdev_pad_ops = {
1495 .enum_mbus_code = s3c_camif_subdev_enum_mbus_code,
1496 .get_selection = s3c_camif_subdev_get_selection,
1497 .set_selection = s3c_camif_subdev_set_selection,
1498 .get_fmt = s3c_camif_subdev_get_fmt,
1499 .set_fmt = s3c_camif_subdev_set_fmt,
1500};
1501
1502static struct v4l2_subdev_ops s3c_camif_subdev_ops = {
1503 .pad = &s3c_camif_subdev_pad_ops,
1504};
1505
1506static int s3c_camif_subdev_s_ctrl(struct v4l2_ctrl *ctrl)
1507{
1508 struct camif_dev *camif = container_of(ctrl->handler, struct camif_dev,
1509 ctrl_handler);
1510 unsigned long flags;
1511
1512 spin_lock_irqsave(&camif->slock, flags);
1513
1514 switch (ctrl->id) {
1515 case V4L2_CID_COLORFX:
1516 camif->colorfx = camif->ctrl_colorfx->val;
1517 /* Set Cb, Cr */
1518 switch (ctrl->val) {
1519 case V4L2_COLORFX_SEPIA:
1520 camif->colorfx_cb = 115;
1521 camif->colorfx_cr = 145;
1522 break;
1523 case V4L2_COLORFX_SET_CBCR:
1524 camif->colorfx_cb = camif->ctrl_colorfx_cbcr->val >> 8;
1525 camif->colorfx_cr = camif->ctrl_colorfx_cbcr->val & 0xff;
1526 break;
1527 default:
1528 /* for V4L2_COLORFX_BW and others */
1529 camif->colorfx_cb = 128;
1530 camif->colorfx_cr = 128;
1531 }
1532 break;
1533 case V4L2_CID_TEST_PATTERN:
1534 camif->test_pattern = camif->ctrl_test_pattern->val;
1535 break;
1536 default:
1537 WARN_ON(1);
1538 }
1539
1540 camif->vp[VP_CODEC].state |= ST_VP_CONFIG;
1541 camif->vp[VP_PREVIEW].state |= ST_VP_CONFIG;
1542 spin_unlock_irqrestore(&camif->slock, flags);
1543
1544 return 0;
1545}
1546
1547static const struct v4l2_ctrl_ops s3c_camif_subdev_ctrl_ops = {
1548 .s_ctrl = s3c_camif_subdev_s_ctrl,
1549};
1550
1551static const char * const s3c_camif_test_pattern_menu[] = {
1552 "Disabled",
1553 "Color bars",
1554 "Horizontal increment",
1555 "Vertical increment",
1556};
1557
1558int s3c_camif_create_subdev(struct camif_dev *camif)
1559{
1560 struct v4l2_ctrl_handler *handler = &camif->ctrl_handler;
1561 struct v4l2_subdev *sd = &camif->subdev;
1562 int ret;
1563
1564 v4l2_subdev_init(sd, &s3c_camif_subdev_ops);
1565 sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
1566 strlcpy(sd->name, "S3C-CAMIF", sizeof(sd->name));
1567
1568 camif->pads[CAMIF_SD_PAD_SINK].flags = MEDIA_PAD_FL_SINK;
1569 camif->pads[CAMIF_SD_PAD_SOURCE_C].flags = MEDIA_PAD_FL_SOURCE;
1570 camif->pads[CAMIF_SD_PAD_SOURCE_P].flags = MEDIA_PAD_FL_SOURCE;
1571
1572 ret = media_entity_init(&sd->entity, CAMIF_SD_PADS_NUM,
1573 camif->pads, 0);
1574 if (ret)
1575 return ret;
1576
1577 v4l2_ctrl_handler_init(handler, 3);
1578 camif->ctrl_test_pattern = v4l2_ctrl_new_std_menu_items(handler,
1579 &s3c_camif_subdev_ctrl_ops, V4L2_CID_TEST_PATTERN,
1580 ARRAY_SIZE(s3c_camif_test_pattern_menu) - 1, 0, 0,
1581 s3c_camif_test_pattern_menu);
1582
7c869651
HV		 1583 if (camif->variant->has_img_effect) {
1584 camif->ctrl_colorfx = v4l2_ctrl_new_std_menu(handler,
babde1c2
SN		 1585 &s3c_camif_subdev_ctrl_ops,
1586 V4L2_CID_COLORFX, V4L2_COLORFX_SET_CBCR,
1587 ~0x981f, V4L2_COLORFX_NONE);
1588
7c869651 1589 camif->ctrl_colorfx_cbcr = v4l2_ctrl_new_std(handler,
babde1c2
SN		 1590 &s3c_camif_subdev_ctrl_ops,
1591 V4L2_CID_COLORFX_CBCR, 0, 0xffff, 1, 0);
7c869651
HV		 1592 }
1593
babde1c2
SN		 1594 if (handler->error) {
1595 v4l2_ctrl_handler_free(handler);
1596 media_entity_cleanup(&sd->entity);
1597 return handler->error;
1598 }
1599
7c869651
HV		 1600 if (camif->variant->has_img_effect)
1601 v4l2_ctrl_auto_cluster(2, &camif->ctrl_colorfx,
babde1c2 1602 V4L2_COLORFX_SET_CBCR, false);
7c869651 1603
babde1c2
SN		 1604 sd->ctrl_handler = handler;
1605 v4l2_set_subdevdata(sd, camif);
1606
1607 return 0;
1608}
1609
1610void s3c_camif_unregister_subdev(struct camif_dev *camif)
1611{
1612 struct v4l2_subdev *sd = &camif->subdev;
1613
1614 /* Return if not registered */
1615 if (v4l2_get_subdevdata(sd) == NULL)
1616 return;
1617
1618 v4l2_device_unregister_subdev(sd);
1619 media_entity_cleanup(&sd->entity);
1620 v4l2_ctrl_handler_free(&camif->ctrl_handler);
1621 v4l2_set_subdevdata(sd, NULL);
1622}
1623
1624int s3c_camif_set_defaults(struct camif_dev *camif)
1625{
1626 unsigned int ip_rev = camif->variant->ip_revision;
1627 int i;
1628
1629 for (i = 0; i < CAMIF_VP_NUM; i++) {
1630 struct camif_vp *vp = &camif->vp[i];
1631 struct camif_frame *f = &vp->out_frame;
1632
1633 vp->camif = camif;
1634 vp->id = i;
1635 vp->offset = camif->variant->vp_offset;
1636
1637 if (ip_rev == S3C244X_CAMIF_IP_REV)
1638 vp->fmt_flags = i ? FMT_FL_S3C24XX_PREVIEW :
1639 FMT_FL_S3C24XX_CODEC;
1640 else
1641 vp->fmt_flags = FMT_FL_S3C64XX;
1642
1643 vp->out_fmt = s3c_camif_find_format(vp, NULL, 0);
1644 BUG_ON(vp->out_fmt == NULL);
1645
1646 memset(f, 0, sizeof(*f));
1647 f->f_width = CAMIF_DEF_WIDTH;
1648 f->f_height = CAMIF_DEF_HEIGHT;
1649 f->rect.width = CAMIF_DEF_WIDTH;
1650 f->rect.height = CAMIF_DEF_HEIGHT;
1651
1652 /* Scaler is always enabled */
1653 vp->scaler.enable = 1;
1654
1655 vp->payload = (f->f_width * f->f_height *
1656 vp->out_fmt->depth) / 8;
1657 }
1658
1659 memset(&camif->mbus_fmt, 0, sizeof(camif->mbus_fmt));
1660 camif->mbus_fmt.width = CAMIF_DEF_WIDTH;
1661 camif->mbus_fmt.height = CAMIF_DEF_HEIGHT;
1662 camif->mbus_fmt.code = camif_mbus_formats[0];
1663
1664 memset(&camif->camif_crop, 0, sizeof(camif->camif_crop));
1665 camif->camif_crop.width = CAMIF_DEF_WIDTH;
1666 camif->camif_crop.height = CAMIF_DEF_HEIGHT;
1667
1668 return 0;
1669}
Ubuntu Hirsute Linux kernel mirror