Lines Matching refs:fimc
142 static int fimc_lite_hw_init(struct fimc_lite *fimc, bool isp_output) in fimc_lite_hw_init() argument
147 if (fimc->sensor == NULL) in fimc_lite_hw_init()
150 if (fimc->inp_frame.fmt == NULL || fimc->out_frame.fmt == NULL) in fimc_lite_hw_init()
154 si = v4l2_get_subdev_hostdata(fimc->sensor); in fimc_lite_hw_init()
158 spin_lock_irqsave(&fimc->slock, flags); in fimc_lite_hw_init()
160 flite_hw_set_camera_bus(fimc, si); in fimc_lite_hw_init()
161 flite_hw_set_source_format(fimc, &fimc->inp_frame); in fimc_lite_hw_init()
162 flite_hw_set_window_offset(fimc, &fimc->inp_frame); in fimc_lite_hw_init()
163 flite_hw_set_dma_buf_mask(fimc, 0); in fimc_lite_hw_init()
164 flite_hw_set_output_dma(fimc, &fimc->out_frame, !isp_output); in fimc_lite_hw_init()
165 flite_hw_set_interrupt_mask(fimc); in fimc_lite_hw_init()
166 flite_hw_set_test_pattern(fimc, fimc->test_pattern->val); in fimc_lite_hw_init()
169 flite_hw_dump_regs(fimc, __func__); in fimc_lite_hw_init()
171 spin_unlock_irqrestore(&fimc->slock, flags); in fimc_lite_hw_init()
183 static int fimc_lite_reinit(struct fimc_lite *fimc, bool suspend) in fimc_lite_reinit() argument
189 spin_lock_irqsave(&fimc->slock, flags); in fimc_lite_reinit()
190 streaming = fimc->state & (1 << ST_SENSOR_STREAM); in fimc_lite_reinit()
192 fimc->state &= ~(1 << ST_FLITE_RUN | 1 << ST_FLITE_OFF | in fimc_lite_reinit()
195 fimc->state |= (1 << ST_FLITE_SUSPENDED); in fimc_lite_reinit()
197 fimc->state &= ~(1 << ST_FLITE_PENDING | in fimc_lite_reinit()
201 while (!suspend && !list_empty(&fimc->pending_buf_q)) { in fimc_lite_reinit()
202 buf = fimc_lite_pending_queue_pop(fimc); in fimc_lite_reinit()
206 while (!list_empty(&fimc->active_buf_q)) { in fimc_lite_reinit()
207 buf = fimc_lite_active_queue_pop(fimc); in fimc_lite_reinit()
209 fimc_lite_pending_queue_add(fimc, buf); in fimc_lite_reinit()
214 spin_unlock_irqrestore(&fimc->slock, flags); in fimc_lite_reinit()
216 flite_hw_reset(fimc); in fimc_lite_reinit()
221 return fimc_pipeline_call(&fimc->ve, set_stream, 0); in fimc_lite_reinit()
224 static int fimc_lite_stop_capture(struct fimc_lite *fimc, bool suspend) in fimc_lite_stop_capture() argument
228 if (!fimc_lite_active(fimc)) in fimc_lite_stop_capture()
231 spin_lock_irqsave(&fimc->slock, flags); in fimc_lite_stop_capture()
232 set_bit(ST_FLITE_OFF, &fimc->state); in fimc_lite_stop_capture()
233 flite_hw_capture_stop(fimc); in fimc_lite_stop_capture()
234 spin_unlock_irqrestore(&fimc->slock, flags); in fimc_lite_stop_capture()
236 wait_event_timeout(fimc->irq_queue, in fimc_lite_stop_capture()
237 !test_bit(ST_FLITE_OFF, &fimc->state), in fimc_lite_stop_capture()
240 return fimc_lite_reinit(fimc, suspend); in fimc_lite_stop_capture()
244 static void fimc_lite_config_update(struct fimc_lite *fimc) in fimc_lite_config_update() argument
246 flite_hw_set_window_offset(fimc, &fimc->inp_frame); in fimc_lite_config_update()
247 flite_hw_set_dma_window(fimc, &fimc->out_frame); in fimc_lite_config_update()
248 flite_hw_set_test_pattern(fimc, fimc->test_pattern->val); in fimc_lite_config_update()
249 clear_bit(ST_FLITE_CONFIG, &fimc->state); in fimc_lite_config_update()
254 struct fimc_lite *fimc = priv; in flite_irq_handler() local
259 spin_lock_irqsave(&fimc->slock, flags); in flite_irq_handler()
261 intsrc = flite_hw_get_interrupt_source(fimc); in flite_irq_handler()
262 flite_hw_clear_pending_irq(fimc); in flite_irq_handler()
264 if (test_and_clear_bit(ST_FLITE_OFF, &fimc->state)) { in flite_irq_handler()
265 wake_up(&fimc->irq_queue); in flite_irq_handler()
270 clear_bit(ST_FLITE_RUN, &fimc->state); in flite_irq_handler()
271 fimc->events.data_overflow++; in flite_irq_handler()
275 flite_hw_clear_last_capture_end(fimc); in flite_irq_handler()
276 clear_bit(ST_FLITE_STREAM, &fimc->state); in flite_irq_handler()
277 wake_up(&fimc->irq_queue); in flite_irq_handler()
280 if (atomic_read(&fimc->out_path) != FIMC_IO_DMA) in flite_irq_handler()
284 test_bit(ST_FLITE_RUN, &fimc->state) && in flite_irq_handler()
285 !list_empty(&fimc->pending_buf_q)) { in flite_irq_handler()
286 vbuf = fimc_lite_pending_queue_pop(fimc); in flite_irq_handler()
287 flite_hw_set_dma_buffer(fimc, vbuf); in flite_irq_handler()
288 fimc_lite_active_queue_add(fimc, vbuf); in flite_irq_handler()
292 test_bit(ST_FLITE_RUN, &fimc->state) && in flite_irq_handler()
293 !list_empty(&fimc->active_buf_q)) { in flite_irq_handler()
294 vbuf = fimc_lite_active_queue_pop(fimc); in flite_irq_handler()
296 vbuf->vb.sequence = fimc->frame_count++; in flite_irq_handler()
297 flite_hw_mask_dma_buffer(fimc, vbuf->index); in flite_irq_handler()
301 if (test_bit(ST_FLITE_CONFIG, &fimc->state)) in flite_irq_handler()
302 fimc_lite_config_update(fimc); in flite_irq_handler()
304 if (list_empty(&fimc->pending_buf_q)) { in flite_irq_handler()
305 flite_hw_capture_stop(fimc); in flite_irq_handler()
306 clear_bit(ST_FLITE_STREAM, &fimc->state); in flite_irq_handler()
309 set_bit(ST_FLITE_RUN, &fimc->state); in flite_irq_handler()
310 spin_unlock_irqrestore(&fimc->slock, flags); in flite_irq_handler()
316 struct fimc_lite *fimc = q->drv_priv; in start_streaming() local
320 spin_lock_irqsave(&fimc->slock, flags); in start_streaming()
322 fimc->buf_index = 0; in start_streaming()
323 fimc->frame_count = 0; in start_streaming()
325 spin_unlock_irqrestore(&fimc->slock, flags); in start_streaming()
327 ret = fimc_lite_hw_init(fimc, false); in start_streaming()
329 fimc_lite_reinit(fimc, false); in start_streaming()
333 set_bit(ST_FLITE_PENDING, &fimc->state); in start_streaming()
335 if (!list_empty(&fimc->active_buf_q) && in start_streaming()
336 !test_and_set_bit(ST_FLITE_STREAM, &fimc->state)) { in start_streaming()
337 flite_hw_capture_start(fimc); in start_streaming()
339 if (!test_and_set_bit(ST_SENSOR_STREAM, &fimc->state)) in start_streaming()
340 fimc_pipeline_call(&fimc->ve, set_stream, 1); in start_streaming()
343 flite_hw_dump_regs(fimc, __func__); in start_streaming()
350 struct fimc_lite *fimc = q->drv_priv; in stop_streaming() local
352 if (!fimc_lite_active(fimc)) in stop_streaming()
355 fimc_lite_stop_capture(fimc, false); in stop_streaming()
364 struct fimc_lite *fimc = vq->drv_priv; in queue_setup() local
365 struct flite_frame *frame = &fimc->out_frame; in queue_setup()
389 allocators[i] = fimc->alloc_ctx; in queue_setup()
398 struct fimc_lite *fimc = vq->drv_priv; in buffer_prepare() local
401 if (fimc->out_frame.fmt == NULL) in buffer_prepare()
404 for (i = 0; i < fimc->out_frame.fmt->memplanes; i++) { in buffer_prepare()
405 unsigned long size = fimc->payload[i]; in buffer_prepare()
408 v4l2_err(&fimc->ve.vdev, in buffer_prepare()
424 struct fimc_lite *fimc = vb2_get_drv_priv(vb->vb2_queue); in buffer_queue() local
427 spin_lock_irqsave(&fimc->slock, flags); in buffer_queue()
430 buf->index = fimc->buf_index++; in buffer_queue()
431 if (fimc->buf_index >= fimc->reqbufs_count) in buffer_queue()
432 fimc->buf_index = 0; in buffer_queue()
434 if (!test_bit(ST_FLITE_SUSPENDED, &fimc->state) && in buffer_queue()
435 !test_bit(ST_FLITE_STREAM, &fimc->state) && in buffer_queue()
436 list_empty(&fimc->active_buf_q)) { in buffer_queue()
437 flite_hw_set_dma_buffer(fimc, buf); in buffer_queue()
438 fimc_lite_active_queue_add(fimc, buf); in buffer_queue()
440 fimc_lite_pending_queue_add(fimc, buf); in buffer_queue()
443 if (vb2_is_streaming(&fimc->vb_queue) && in buffer_queue()
444 !list_empty(&fimc->pending_buf_q) && in buffer_queue()
445 !test_and_set_bit(ST_FLITE_STREAM, &fimc->state)) { in buffer_queue()
446 flite_hw_capture_start(fimc); in buffer_queue()
447 spin_unlock_irqrestore(&fimc->slock, flags); in buffer_queue()
449 if (!test_and_set_bit(ST_SENSOR_STREAM, &fimc->state)) in buffer_queue()
450 fimc_pipeline_call(&fimc->ve, set_stream, 1); in buffer_queue()
453 spin_unlock_irqrestore(&fimc->slock, flags); in buffer_queue()
466 static void fimc_lite_clear_event_counters(struct fimc_lite *fimc) in fimc_lite_clear_event_counters() argument
470 spin_lock_irqsave(&fimc->slock, flags); in fimc_lite_clear_event_counters()
471 memset(&fimc->events, 0, sizeof(fimc->events)); in fimc_lite_clear_event_counters()
472 spin_unlock_irqrestore(&fimc->slock, flags); in fimc_lite_clear_event_counters()
477 struct fimc_lite *fimc = video_drvdata(file); in fimc_lite_open() local
478 struct media_entity *me = &fimc->ve.vdev.entity; in fimc_lite_open()
481 mutex_lock(&fimc->lock); in fimc_lite_open()
482 if (atomic_read(&fimc->out_path) != FIMC_IO_DMA) { in fimc_lite_open()
487 set_bit(ST_FLITE_IN_USE, &fimc->state); in fimc_lite_open()
488 ret = pm_runtime_get_sync(&fimc->pdev->dev); in fimc_lite_open()
497 atomic_read(&fimc->out_path) != FIMC_IO_DMA) in fimc_lite_open()
502 ret = fimc_pipeline_call(&fimc->ve, open, me, true); in fimc_lite_open()
511 fimc_lite_clear_event_counters(fimc); in fimc_lite_open()
517 pm_runtime_put_sync(&fimc->pdev->dev); in fimc_lite_open()
518 clear_bit(ST_FLITE_IN_USE, &fimc->state); in fimc_lite_open()
520 mutex_unlock(&fimc->lock); in fimc_lite_open()
526 struct fimc_lite *fimc = video_drvdata(file); in fimc_lite_release() local
527 struct media_entity *entity = &fimc->ve.vdev.entity; in fimc_lite_release()
529 mutex_lock(&fimc->lock); in fimc_lite_release()
532 atomic_read(&fimc->out_path) == FIMC_IO_DMA) { in fimc_lite_release()
533 if (fimc->streaming) { in fimc_lite_release()
535 fimc->streaming = false; in fimc_lite_release()
537 fimc_lite_stop_capture(fimc, false); in fimc_lite_release()
538 fimc_pipeline_call(&fimc->ve, close); in fimc_lite_release()
539 clear_bit(ST_FLITE_IN_USE, &fimc->state); in fimc_lite_release()
547 pm_runtime_put(&fimc->pdev->dev); in fimc_lite_release()
548 clear_bit(ST_FLITE_SUSPENDED, &fimc->state); in fimc_lite_release()
550 mutex_unlock(&fimc->lock); in fimc_lite_release()
567 static const struct fimc_fmt *fimc_lite_subdev_try_fmt(struct fimc_lite *fimc, in fimc_lite_subdev_try_fmt() argument
571 struct flite_drvdata *dd = fimc->dd; in fimc_lite_subdev_try_fmt()
587 struct flite_frame *sink = &fimc->inp_frame; in fimc_lite_subdev_try_fmt()
592 sink_fmt = v4l2_subdev_get_try_format(&fimc->subdev, cfg, in fimc_lite_subdev_try_fmt()
598 rect = v4l2_subdev_get_try_crop(&fimc->subdev, cfg, in fimc_lite_subdev_try_fmt()
613 v4l2_dbg(1, debug, &fimc->subdev, "code: %#x (%d), %dx%d\n", in fimc_lite_subdev_try_fmt()
619 static void fimc_lite_try_crop(struct fimc_lite *fimc, struct v4l2_rect *r) in fimc_lite_try_crop() argument
621 struct flite_frame *frame = &fimc->inp_frame; in fimc_lite_try_crop()
628 r->left = round_down(r->left, fimc->dd->win_hor_offs_align); in fimc_lite_try_crop()
631 v4l2_dbg(1, debug, &fimc->subdev, "(%d,%d)/%dx%d, sink fmt: %dx%d\n", in fimc_lite_try_crop()
636 static void fimc_lite_try_compose(struct fimc_lite *fimc, struct v4l2_rect *r) in fimc_lite_try_compose() argument
638 struct flite_frame *frame = &fimc->out_frame; in fimc_lite_try_compose()
639 struct v4l2_rect *crop_rect = &fimc->inp_frame.rect; in fimc_lite_try_compose()
648 r->left = round_down(r->left, fimc->dd->out_hor_offs_align); in fimc_lite_try_compose()
649 r->top = clamp_t(u32, r->top, 0, fimc->out_frame.f_height - r->height); in fimc_lite_try_compose()
651 v4l2_dbg(1, debug, &fimc->subdev, "(%d,%d)/%dx%d, source fmt: %dx%d\n", in fimc_lite_try_compose()
662 struct fimc_lite *fimc = video_drvdata(file); in fimc_lite_querycap() local
667 dev_name(&fimc->pdev->dev)); in fimc_lite_querycap()
692 struct fimc_lite *fimc = video_drvdata(file); in fimc_lite_g_fmt_mplane() local
695 struct flite_frame *frame = &fimc->out_frame; in fimc_lite_g_fmt_mplane()
710 static int fimc_lite_try_fmt(struct fimc_lite *fimc, in fimc_lite_try_fmt() argument
715 struct flite_drvdata *dd = fimc->dd; in fimc_lite_try_fmt()
716 const struct fimc_fmt *inp_fmt = fimc->inp_frame.fmt; in fimc_lite_try_fmt()
757 struct fimc_lite *fimc = video_drvdata(file); in fimc_lite_try_fmt_mplane() local
758 return fimc_lite_try_fmt(fimc, &f->fmt.pix_mp, NULL); in fimc_lite_try_fmt_mplane()
765 struct fimc_lite *fimc = video_drvdata(file); in fimc_lite_s_fmt_mplane() local
766 struct flite_frame *frame = &fimc->out_frame; in fimc_lite_s_fmt_mplane()
770 if (vb2_is_busy(&fimc->vb_queue)) in fimc_lite_s_fmt_mplane()
773 ret = fimc_lite_try_fmt(fimc, &f->fmt.pix_mp, &fmt); in fimc_lite_s_fmt_mplane()
778 fimc->payload[0] = max((pixm->width * pixm->height * fmt->depth[0]) / 8, in fimc_lite_s_fmt_mplane()
786 static int fimc_pipeline_validate(struct fimc_lite *fimc) in fimc_pipeline_validate() argument
788 struct v4l2_subdev *sd = &fimc->subdev; in fimc_pipeline_validate()
799 if (sd == &fimc->subdev) { in fimc_pipeline_validate()
800 struct flite_frame *ff = &fimc->out_frame; in fimc_pipeline_validate()
803 sink_fmt.format.code = fimc->inp_frame.fmt->mbus_code; in fimc_pipeline_validate()
836 struct fimc_lite *fimc = video_drvdata(file); in fimc_lite_streamon() local
837 struct media_entity *entity = &fimc->ve.vdev.entity; in fimc_lite_streamon()
840 if (fimc_lite_active(fimc)) in fimc_lite_streamon()
843 ret = media_entity_pipeline_start(entity, &fimc->ve.pipe->mp); in fimc_lite_streamon()
847 ret = fimc_pipeline_validate(fimc); in fimc_lite_streamon()
851 fimc->sensor = fimc_find_remote_sensor(&fimc->subdev.entity); in fimc_lite_streamon()
855 fimc->streaming = true; in fimc_lite_streamon()
867 struct fimc_lite *fimc = video_drvdata(file); in fimc_lite_streamoff() local
874 media_entity_pipeline_stop(&fimc->ve.vdev.entity); in fimc_lite_streamoff()
875 fimc->streaming = false; in fimc_lite_streamoff()
882 struct fimc_lite *fimc = video_drvdata(file); in fimc_lite_reqbufs() local
888 fimc->reqbufs_count = reqbufs->count; in fimc_lite_reqbufs()
909 struct fimc_lite *fimc = video_drvdata(file); in fimc_lite_g_selection() local
910 struct flite_frame *f = &fimc->out_frame; in fimc_lite_g_selection()
935 struct fimc_lite *fimc = video_drvdata(file); in fimc_lite_s_selection() local
936 struct flite_frame *f = &fimc->out_frame; in fimc_lite_s_selection()
944 fimc_lite_try_compose(fimc, &rect); in fimc_lite_s_selection()
955 spin_lock_irqsave(&fimc->slock, flags); in fimc_lite_s_selection()
957 set_bit(ST_FLITE_CONFIG, &fimc->state); in fimc_lite_s_selection()
958 spin_unlock_irqrestore(&fimc->slock, flags); in fimc_lite_s_selection()
987 struct fimc_lite *fimc = v4l2_get_subdevdata(sd); in fimc_lite_link_setup() local
991 if (WARN_ON(fimc == NULL)) in fimc_lite_link_setup()
996 flags, fimc->source_subdev_grp_id); in fimc_lite_link_setup()
1005 if (fimc->source_subdev_grp_id == 0) in fimc_lite_link_setup()
1006 fimc->source_subdev_grp_id = sd->grp_id; in fimc_lite_link_setup()
1010 fimc->source_subdev_grp_id = 0; in fimc_lite_link_setup()
1011 fimc->sensor = NULL; in fimc_lite_link_setup()
1017 atomic_set(&fimc->out_path, FIMC_IO_NONE); in fimc_lite_link_setup()
1019 atomic_set(&fimc->out_path, FIMC_IO_DMA); in fimc_lite_link_setup()
1026 atomic_set(&fimc->out_path, FIMC_IO_NONE); in fimc_lite_link_setup()
1028 atomic_set(&fimc->out_path, FIMC_IO_ISP); in fimc_lite_link_setup()
1073 struct fimc_lite *fimc = v4l2_get_subdevdata(sd); in fimc_lite_subdev_get_fmt() local
1075 struct flite_frame *f = &fimc->inp_frame; in fimc_lite_subdev_get_fmt()
1083 mutex_lock(&fimc->lock); in fimc_lite_subdev_get_fmt()
1096 mutex_unlock(&fimc->lock); in fimc_lite_subdev_get_fmt()
1104 struct fimc_lite *fimc = v4l2_get_subdevdata(sd); in fimc_lite_subdev_set_fmt() local
1106 struct flite_frame *sink = &fimc->inp_frame; in fimc_lite_subdev_set_fmt()
1107 struct flite_frame *source = &fimc->out_frame; in fimc_lite_subdev_set_fmt()
1113 mutex_lock(&fimc->lock); in fimc_lite_subdev_set_fmt()
1115 if ((atomic_read(&fimc->out_path) == FIMC_IO_ISP && in fimc_lite_subdev_set_fmt()
1117 (atomic_read(&fimc->out_path) == FIMC_IO_DMA && in fimc_lite_subdev_set_fmt()
1118 vb2_is_busy(&fimc->vb_queue))) { in fimc_lite_subdev_set_fmt()
1119 mutex_unlock(&fimc->lock); in fimc_lite_subdev_set_fmt()
1123 ffmt = fimc_lite_subdev_try_fmt(fimc, cfg, fmt); in fimc_lite_subdev_set_fmt()
1137 mutex_unlock(&fimc->lock); in fimc_lite_subdev_set_fmt()
1156 mutex_unlock(&fimc->lock); in fimc_lite_subdev_set_fmt()
1164 struct fimc_lite *fimc = v4l2_get_subdevdata(sd); in fimc_lite_subdev_get_selection() local
1165 struct flite_frame *f = &fimc->inp_frame; in fimc_lite_subdev_get_selection()
1177 mutex_lock(&fimc->lock); in fimc_lite_subdev_get_selection()
1186 mutex_unlock(&fimc->lock); in fimc_lite_subdev_get_selection()
1199 struct fimc_lite *fimc = v4l2_get_subdevdata(sd); in fimc_lite_subdev_set_selection() local
1200 struct flite_frame *f = &fimc->inp_frame; in fimc_lite_subdev_set_selection()
1206 mutex_lock(&fimc->lock); in fimc_lite_subdev_set_selection()
1207 fimc_lite_try_crop(fimc, &sel->r); in fimc_lite_subdev_set_selection()
1213 spin_lock_irqsave(&fimc->slock, flags); in fimc_lite_subdev_set_selection()
1216 fimc->out_frame.rect = sel->r; in fimc_lite_subdev_set_selection()
1217 set_bit(ST_FLITE_CONFIG, &fimc->state); in fimc_lite_subdev_set_selection()
1218 spin_unlock_irqrestore(&fimc->slock, flags); in fimc_lite_subdev_set_selection()
1220 mutex_unlock(&fimc->lock); in fimc_lite_subdev_set_selection()
1231 struct fimc_lite *fimc = v4l2_get_subdevdata(sd); in fimc_lite_subdev_s_stream() local
1242 fimc->sensor = fimc_find_remote_sensor(&sd->entity); in fimc_lite_subdev_s_stream()
1244 if (atomic_read(&fimc->out_path) != FIMC_IO_ISP) in fimc_lite_subdev_s_stream()
1247 mutex_lock(&fimc->lock); in fimc_lite_subdev_s_stream()
1249 flite_hw_reset(fimc); in fimc_lite_subdev_s_stream()
1250 ret = fimc_lite_hw_init(fimc, true); in fimc_lite_subdev_s_stream()
1252 spin_lock_irqsave(&fimc->slock, flags); in fimc_lite_subdev_s_stream()
1253 flite_hw_capture_start(fimc); in fimc_lite_subdev_s_stream()
1254 spin_unlock_irqrestore(&fimc->slock, flags); in fimc_lite_subdev_s_stream()
1257 set_bit(ST_FLITE_OFF, &fimc->state); in fimc_lite_subdev_s_stream()
1259 spin_lock_irqsave(&fimc->slock, flags); in fimc_lite_subdev_s_stream()
1260 flite_hw_capture_stop(fimc); in fimc_lite_subdev_s_stream()
1261 spin_unlock_irqrestore(&fimc->slock, flags); in fimc_lite_subdev_s_stream()
1263 ret = wait_event_timeout(fimc->irq_queue, in fimc_lite_subdev_s_stream()
1264 !test_bit(ST_FLITE_OFF, &fimc->state), in fimc_lite_subdev_s_stream()
1268 clear_bit(ST_FLITE_RUN, &fimc->state); in fimc_lite_subdev_s_stream()
1271 mutex_unlock(&fimc->lock); in fimc_lite_subdev_s_stream()
1277 struct fimc_lite *fimc = v4l2_get_subdevdata(sd); in fimc_lite_log_status() local
1279 flite_hw_dump_regs(fimc, __func__); in fimc_lite_log_status()
1285 struct fimc_lite *fimc = v4l2_get_subdevdata(sd); in fimc_lite_subdev_registered() local
1286 struct vb2_queue *q = &fimc->vb_queue; in fimc_lite_subdev_registered()
1287 struct video_device *vfd = &fimc->ve.vdev; in fimc_lite_subdev_registered()
1291 atomic_set(&fimc->out_path, FIMC_IO_DMA); in fimc_lite_subdev_registered()
1294 fimc->index); in fimc_lite_subdev_registered()
1302 fimc->reqbufs_count = 0; in fimc_lite_subdev_registered()
1304 INIT_LIST_HEAD(&fimc->pending_buf_q); in fimc_lite_subdev_registered()
1305 INIT_LIST_HEAD(&fimc->active_buf_q); in fimc_lite_subdev_registered()
1313 q->drv_priv = fimc; in fimc_lite_subdev_registered()
1315 q->lock = &fimc->lock; in fimc_lite_subdev_registered()
1321 fimc->vd_pad.flags = MEDIA_PAD_FL_SINK; in fimc_lite_subdev_registered()
1322 ret = media_entity_init(&vfd->entity, 1, &fimc->vd_pad, 0); in fimc_lite_subdev_registered()
1326 video_set_drvdata(vfd, fimc); in fimc_lite_subdev_registered()
1327 fimc->ve.pipe = v4l2_get_subdev_hostdata(sd); in fimc_lite_subdev_registered()
1332 fimc->ve.pipe = NULL; in fimc_lite_subdev_registered()
1343 struct fimc_lite *fimc = v4l2_get_subdevdata(sd); in fimc_lite_subdev_unregistered() local
1345 if (fimc == NULL) in fimc_lite_subdev_unregistered()
1348 mutex_lock(&fimc->lock); in fimc_lite_subdev_unregistered()
1350 if (video_is_registered(&fimc->ve.vdev)) { in fimc_lite_subdev_unregistered()
1351 video_unregister_device(&fimc->ve.vdev); in fimc_lite_subdev_unregistered()
1352 media_entity_cleanup(&fimc->ve.vdev.entity); in fimc_lite_subdev_unregistered()
1353 fimc->ve.pipe = NULL; in fimc_lite_subdev_unregistered()
1356 mutex_unlock(&fimc->lock); in fimc_lite_subdev_unregistered()
1388 struct fimc_lite *fimc = container_of(ctrl->handler, struct fimc_lite, in fimc_lite_s_ctrl() local
1390 set_bit(ST_FLITE_CONFIG, &fimc->state); in fimc_lite_s_ctrl()
1406 static void fimc_lite_set_default_config(struct fimc_lite *fimc) in fimc_lite_set_default_config() argument
1408 struct flite_frame *sink = &fimc->inp_frame; in fimc_lite_set_default_config()
1409 struct flite_frame *source = &fimc->out_frame; in fimc_lite_set_default_config()
1423 static int fimc_lite_create_capture_subdev(struct fimc_lite *fimc) in fimc_lite_create_capture_subdev() argument
1425 struct v4l2_ctrl_handler *handler = &fimc->ctrl_handler; in fimc_lite_create_capture_subdev()
1426 struct v4l2_subdev *sd = &fimc->subdev; in fimc_lite_create_capture_subdev()
1431 snprintf(sd->name, sizeof(sd->name), "FIMC-LITE.%d", fimc->index); in fimc_lite_create_capture_subdev()
1433 fimc->subdev_pads[FLITE_SD_PAD_SINK].flags = MEDIA_PAD_FL_SINK; in fimc_lite_create_capture_subdev()
1434 fimc->subdev_pads[FLITE_SD_PAD_SOURCE_DMA].flags = MEDIA_PAD_FL_SOURCE; in fimc_lite_create_capture_subdev()
1435 fimc->subdev_pads[FLITE_SD_PAD_SOURCE_ISP].flags = MEDIA_PAD_FL_SOURCE; in fimc_lite_create_capture_subdev()
1437 fimc->subdev_pads, 0); in fimc_lite_create_capture_subdev()
1442 fimc->test_pattern = v4l2_ctrl_new_custom(handler, &fimc_lite_ctrl, in fimc_lite_create_capture_subdev()
1453 v4l2_set_subdevdata(sd, fimc); in fimc_lite_create_capture_subdev()
1458 static void fimc_lite_unregister_capture_subdev(struct fimc_lite *fimc) in fimc_lite_unregister_capture_subdev() argument
1460 struct v4l2_subdev *sd = &fimc->subdev; in fimc_lite_unregister_capture_subdev()
1464 v4l2_ctrl_handler_free(&fimc->ctrl_handler); in fimc_lite_unregister_capture_subdev()
1468 static void fimc_lite_clk_put(struct fimc_lite *fimc) in fimc_lite_clk_put() argument
1470 if (IS_ERR(fimc->clock)) in fimc_lite_clk_put()
1473 clk_unprepare(fimc->clock); in fimc_lite_clk_put()
1474 clk_put(fimc->clock); in fimc_lite_clk_put()
1475 fimc->clock = ERR_PTR(-EINVAL); in fimc_lite_clk_put()
1478 static int fimc_lite_clk_get(struct fimc_lite *fimc) in fimc_lite_clk_get() argument
1482 fimc->clock = clk_get(&fimc->pdev->dev, FLITE_CLK_NAME); in fimc_lite_clk_get()
1483 if (IS_ERR(fimc->clock)) in fimc_lite_clk_get()
1484 return PTR_ERR(fimc->clock); in fimc_lite_clk_get()
1486 ret = clk_prepare(fimc->clock); in fimc_lite_clk_get()
1488 clk_put(fimc->clock); in fimc_lite_clk_get()
1489 fimc->clock = ERR_PTR(-EINVAL); in fimc_lite_clk_get()
1501 struct fimc_lite *fimc; in fimc_lite_probe() local
1508 fimc = devm_kzalloc(dev, sizeof(*fimc), GFP_KERNEL); in fimc_lite_probe()
1509 if (!fimc) in fimc_lite_probe()
1515 fimc->index = of_alias_get_id(dev->of_node, "fimc-lite"); in fimc_lite_probe()
1517 if (!drv_data || fimc->index >= drv_data->num_instances || in fimc_lite_probe()
1518 fimc->index < 0) { in fimc_lite_probe()
1524 fimc->dd = drv_data; in fimc_lite_probe()
1525 fimc->pdev = pdev; in fimc_lite_probe()
1527 init_waitqueue_head(&fimc->irq_queue); in fimc_lite_probe()
1528 spin_lock_init(&fimc->slock); in fimc_lite_probe()
1529 mutex_init(&fimc->lock); in fimc_lite_probe()
1532 fimc->regs = devm_ioremap_resource(dev, res); in fimc_lite_probe()
1533 if (IS_ERR(fimc->regs)) in fimc_lite_probe()
1534 return PTR_ERR(fimc->regs); in fimc_lite_probe()
1542 ret = fimc_lite_clk_get(fimc); in fimc_lite_probe()
1547 0, dev_name(dev), fimc); in fimc_lite_probe()
1554 ret = fimc_lite_create_capture_subdev(fimc); in fimc_lite_probe()
1558 platform_set_drvdata(pdev, fimc); in fimc_lite_probe()
1562 ret = clk_enable(fimc->clock); in fimc_lite_probe()
1567 fimc->alloc_ctx = vb2_dma_contig_init_ctx(dev); in fimc_lite_probe()
1568 if (IS_ERR(fimc->alloc_ctx)) { in fimc_lite_probe()
1569 ret = PTR_ERR(fimc->alloc_ctx); in fimc_lite_probe()
1573 fimc_lite_set_default_config(fimc); in fimc_lite_probe()
1576 fimc->index); in fimc_lite_probe()
1581 clk_disable(fimc->clock); in fimc_lite_probe()
1583 fimc_lite_unregister_capture_subdev(fimc); in fimc_lite_probe()
1585 fimc_lite_clk_put(fimc); in fimc_lite_probe()
1592 struct fimc_lite *fimc = dev_get_drvdata(dev); in fimc_lite_runtime_resume() local
1594 clk_enable(fimc->clock); in fimc_lite_runtime_resume()
1600 struct fimc_lite *fimc = dev_get_drvdata(dev); in fimc_lite_runtime_suspend() local
1602 clk_disable(fimc->clock); in fimc_lite_runtime_suspend()
1610 struct fimc_lite *fimc = dev_get_drvdata(dev); in fimc_lite_resume() local
1615 spin_lock_irqsave(&fimc->slock, flags); in fimc_lite_resume()
1616 if (!test_and_clear_bit(ST_LPM, &fimc->state) || in fimc_lite_resume()
1617 !test_bit(ST_FLITE_IN_USE, &fimc->state)) { in fimc_lite_resume()
1618 spin_unlock_irqrestore(&fimc->slock, flags); in fimc_lite_resume()
1621 flite_hw_reset(fimc); in fimc_lite_resume()
1622 spin_unlock_irqrestore(&fimc->slock, flags); in fimc_lite_resume()
1624 if (!test_and_clear_bit(ST_FLITE_SUSPENDED, &fimc->state)) in fimc_lite_resume()
1627 INIT_LIST_HEAD(&fimc->active_buf_q); in fimc_lite_resume()
1628 fimc_pipeline_call(&fimc->ve, open, in fimc_lite_resume()
1629 &fimc->ve.vdev.entity, false); in fimc_lite_resume()
1630 fimc_lite_hw_init(fimc, atomic_read(&fimc->out_path) == FIMC_IO_ISP); in fimc_lite_resume()
1631 clear_bit(ST_FLITE_SUSPENDED, &fimc->state); in fimc_lite_resume()
1633 for (i = 0; i < fimc->reqbufs_count; i++) { in fimc_lite_resume()
1634 if (list_empty(&fimc->pending_buf_q)) in fimc_lite_resume()
1636 buf = fimc_lite_pending_queue_pop(fimc); in fimc_lite_resume()
1644 struct fimc_lite *fimc = dev_get_drvdata(dev); in fimc_lite_suspend() local
1645 bool suspend = test_bit(ST_FLITE_IN_USE, &fimc->state); in fimc_lite_suspend()
1648 if (test_and_set_bit(ST_LPM, &fimc->state)) in fimc_lite_suspend()
1651 ret = fimc_lite_stop_capture(fimc, suspend); in fimc_lite_suspend()
1652 if (ret < 0 || !fimc_lite_active(fimc)) in fimc_lite_suspend()
1655 return fimc_pipeline_call(&fimc->ve, close); in fimc_lite_suspend()
1661 struct fimc_lite *fimc = platform_get_drvdata(pdev); in fimc_lite_remove() local
1666 fimc_lite_unregister_capture_subdev(fimc); in fimc_lite_remove()
1667 vb2_dma_contig_cleanup_ctx(fimc->alloc_ctx); in fimc_lite_remove()
1668 fimc_lite_clk_put(fimc); in fimc_lite_remove()