stm32/stm32-dcmipp/dcmipp-bytecap.c

187 	struct dcmipp_bytecap_device *vcap = video_drvdata(file);
189 	f->fmt.pix = vcap->format;
197 	struct dcmipp_bytecap_device *vcap = video_drvdata(file);
215 		dev_dbg(vcap->dev, "resolution updated: %dx%d -> %dx%d\n",
237 	struct dcmipp_bytecap_device *vcap = video_drvdata(file);
241 	if (vb2_is_busy(&vcap->queue))
248 	dev_dbg(vcap->dev, "%s: format update: old:%ux%u (0x%p4cc, %u, %u, %u, %u) new:%ux%d (0x%p4cc, %u, %u, %u, %u)\n",
249 		vcap->vdev.name,
251 		vcap->format.width, vcap->format.height,
252 		&vcap->format.pixelformat, vcap->format.colorspace,
253 		vcap->format.quantization, vcap->format.xfer_func,
254 		vcap->format.ycbcr_enc,
261 	vcap->format = f->fmt.pix;
358 static void dcmipp_start_capture(struct dcmipp_bytecap_device *vcap,
362 	reg_write(vcap, DCMIPP_P0PPM0AR1, buf->addr);
365 	reg_write(vcap, DCMIPP_P0DCLMTR, DCMIPP_P0DCLMTR_ENABLE |
369 	reg_set(vcap, DCMIPP_P0FCTCR, DCMIPP_P0FCTCR_CPTREQ);
372 static void dcmipp_bytecap_all_buffers_done(struct dcmipp_bytecap_device *vcap,
377 	list_for_each_entry_safe(buf, node, &vcap->buffers, list) {
386 	struct dcmipp_bytecap_device *vcap = vb2_get_drv_priv(vq);
387 	struct media_entity *entity = &vcap->vdev.entity;
392 	vcap->sequence = 0;
393 	memset(&vcap->count, 0, sizeof(vcap->count));
399 	if (!vcap->s_subdev) {
400 		pad = media_pad_remote_pad_first(&vcap->vdev.entity.pads[0]);
403 		vcap->s_subdev = media_entity_to_v4l2_subdev(pad->entity);
404 		vcap->s_subdev_pad_nb = pad->index;
407 	ret = pm_runtime_resume_and_get(vcap->dev);
409 		dev_err(vcap->dev, "%s: Failed to start streaming, cannot get sync (%d)\n",
414 	ret = media_pipeline_start(entity->pads, &vcap->pipe);
416 		dev_dbg(vcap->dev, "%s: Failed to start streaming, media pipeline start error (%d)\n",
421 	ret = v4l2_subdev_enable_streams(vcap->s_subdev,
422 					 vcap->s_subdev_pad_nb, BIT_ULL(0));
426 	spin_lock_irq(&vcap->irqlock);
429 	reg_set(vcap, DCMIPP_P0FSCR, DCMIPP_P0FSCR_PIPEN);
435 	vcap->next = list_first_entry(&vcap->buffers, typeof(*buf), list);
436 	dev_dbg(vcap->dev, "Start with next [%d] %p phy=%pad\n",
437 		vcap->next->vb.vb2_buf.index, vcap->next, &vcap->next->addr);
439 	dcmipp_start_capture(vcap, vcap->next);
442 	vcap->cmier |= DCMIPP_CMIER_P0ALL;
443 	reg_set(vcap, DCMIPP_CMIER, vcap->cmier);
445 	vcap->state = DCMIPP_RUNNING;
447 	spin_unlock_irq(&vcap->irqlock);
454 	pm_runtime_put(vcap->dev);
456 	spin_lock_irq(&vcap->irqlock);
461 	dcmipp_bytecap_all_buffers_done(vcap, VB2_BUF_STATE_QUEUED);
462 	vcap->active = NULL;
463 	spin_unlock_irq(&vcap->irqlock);
468 static void dcmipp_dump_status(struct dcmipp_bytecap_device *vcap)
470 	struct device *dev = vcap->dev;
472 	dev_dbg(dev, "[DCMIPP_PRSR]  =%#10.8x\n", reg_read(vcap, DCMIPP_PRSR));
473 	dev_dbg(dev, "[DCMIPP_P0SR] =%#10.8x\n", reg_read(vcap, DCMIPP_P0SR));
475 		reg_read(vcap, DCMIPP_P0DCCNTR));
476 	dev_dbg(dev, "[DCMIPP_CMSR1] =%#10.8x\n", reg_read(vcap, DCMIPP_CMSR1));
477 	dev_dbg(dev, "[DCMIPP_CMSR2] =%#10.8x\n", reg_read(vcap, DCMIPP_CMSR2));
486 	struct dcmipp_bytecap_device *vcap = vb2_get_drv_priv(vq);
490 	ret = v4l2_subdev_disable_streams(vcap->s_subdev,
491 					  vcap->s_subdev_pad_nb, BIT_ULL(0));
493 		dev_warn(vcap->dev, "Failed to disable stream\n");
496 	media_pipeline_stop(vcap->vdev.entity.pads);
499 	reg_clear(vcap, DCMIPP_CMIER, vcap->cmier);
502 	reg_clear(vcap, DCMIPP_P0FCTCR, DCMIPP_P0FCTCR_CPTREQ);
505 	ret = readl_relaxed_poll_timeout(vcap->regs + DCMIPP_P0SR, status,
510 		dev_warn(vcap->dev, "Timeout when stopping\n");
513 	reg_clear(vcap, DCMIPP_P0FSCR, DCMIPP_P0FSCR_PIPEN);
515 	spin_lock_irq(&vcap->irqlock);
518 	dcmipp_bytecap_all_buffers_done(vcap, VB2_BUF_STATE_ERROR);
519 	INIT_LIST_HEAD(&vcap->buffers);
521 	vcap->active = NULL;
522 	vcap->state = DCMIPP_STOPPED;
524 	spin_unlock_irq(&vcap->irqlock);
526 	dcmipp_dump_status(vcap);
528 	pm_runtime_put(vcap->dev);
530 	if (vcap->count.errors)
531 		dev_warn(vcap->dev, "Some errors found while streaming: errors=%d (overrun=%d, limit=%d, nactive=%d), underrun=%d, buffers=%d\n",
532 			 vcap->count.errors, vcap->count.overrun,
533 			 vcap->count.limit, vcap->count.nactive,
534 			 vcap->count.underrun, vcap->count.buffers);
539 	struct dcmipp_bytecap_device *vcap =  vb2_get_drv_priv(vb->vb2_queue);
544 	size = vcap->format.sizeimage;
547 		dev_err(vcap->dev, "%s data will not fit into plane (%lu < %lu)\n",
562 		dev_dbg(vcap->dev, "Setup [%d] phy=%pad size=%zu\n",
571 	struct dcmipp_bytecap_device *vcap =
576 	dev_dbg(vcap->dev, "Queue [%d] %p phy=%pad\n", buf->vb.vb2_buf.index,
579 	spin_lock_irq(&vcap->irqlock);
580 	list_add_tail(&buf->list, &vcap->buffers);
582 	if (vcap->state == DCMIPP_WAIT_FOR_BUFFER) {
583 		vcap->next = buf;
584 		dev_dbg(vcap->dev, "Restart with next [%d] %p phy=%pad\n",
587 		dcmipp_start_capture(vcap, buf);
589 		vcap->state = DCMIPP_RUNNING;
592 	spin_unlock_irq(&vcap->irqlock);
601 	struct dcmipp_bytecap_device *vcap = vb2_get_drv_priv(vq);
604 	size = vcap->format.sizeimage;
608 		return sizes[0] < vcap->format.sizeimage ? -EINVAL : 0;
611 	sizes[0] = vcap->format.sizeimage;
613 	dev_dbg(vcap->dev, "Setup queue, count=%d, size=%d\n",
640 	struct dcmipp_bytecap_device *vcap =
643 	dcmipp_pads_cleanup(vcap->ved.pads);
644 	mutex_destroy(&vcap->lock);
646 	kfree(vcap);
651 	struct dcmipp_bytecap_device *vcap =
655 	vb2_video_unregister_device(&vcap->vdev);
658 static void dcmipp_buffer_done(struct dcmipp_bytecap_device *vcap,
669 	vbuf->sequence = vcap->sequence++;
675 	dev_dbg(vcap->dev, "Done  [%d] %p phy=%pad\n", buf->vb.vb2_buf.index,
677 	vcap->count.buffers++;
682 dcmipp_bytecap_set_next_frame_or_stop(struct dcmipp_bytecap_device *vcap)
684 	if (!vcap->next && list_is_singular(&vcap->buffers)) {
691 		reg_clear(vcap, DCMIPP_P0FCTCR, DCMIPP_P0FCTCR_CPTREQ);
693 		dev_dbg(vcap->dev, "Capture restart is deferred to next buffer queueing\n");
694 		vcap->next = NULL;
695 		vcap->state = DCMIPP_WAIT_FOR_BUFFER;
700 	if (!vcap->next)
701 		vcap->next = list_next_entry(vcap->active, list);
708 	reg_write(vcap, DCMIPP_P0PPM0AR1, vcap->next->addr);
709 	dev_dbg(vcap->dev, "Write [%d] %p phy=%pad\n",
710 		vcap->next->vb.vb2_buf.index, vcap->next, &vcap->next->addr);
714 static void dcmipp_bytecap_process_frame(struct dcmipp_bytecap_device *vcap,
718 	struct dcmipp_buf *buf = vcap->active;
721 		vcap->count.nactive++;
722 		vcap->count.errors++;
727 		dev_dbg(vcap->dev, "frame larger than expected (%zu > %zu)\n",
731 		vcap->count.limit++;
732 		vcap->count.errors++;
736 	dcmipp_buffer_done(vcap, buf, bytesused, err);
737 	vcap->active = NULL;
742 	struct dcmipp_bytecap_device *vcap =
747 	spin_lock_irq(&vcap->irqlock);
749 	cmsr2 = vcap->cmsr2 & vcap->cmier;
757 		vcap->count.errors++;
758 		vcap->count.overrun++;
762 		vcap->count.frame++;
765 		bytesused = reg_read(vcap, DCMIPP_P0DCCNTR);
766 		dcmipp_bytecap_process_frame(vcap, bytesused);
770 		vcap->count.vsync++;
771 		if (vcap->state == DCMIPP_WAIT_FOR_BUFFER) {
772 			vcap->count.underrun++;
785 		swap(vcap->active, vcap->next);
786 		dcmipp_bytecap_set_next_frame_or_stop(vcap);
790 	spin_unlock_irq(&vcap->irqlock);
796 	struct dcmipp_bytecap_device *vcap =
800 	vcap->cmsr2 = reg_read(vcap, DCMIPP_CMSR2) & vcap->cmier;
801 	vcap->count.it++;
804 	reg_write(vcap, DCMIPP_CMFCR, vcap->cmsr2);
813 	struct dcmipp_bytecap_device *vcap = container_of(vd,
827 	if (source_fmt.format.width != vcap->format.width ||
828 	    source_fmt.format.height != vcap->format.height) {
829 		dev_err(vcap->dev, "Wrong width or height %ux%u (%ux%u expected)\n",
830 			vcap->format.width, vcap->format.height,
837 			vcap->format.pixelformat &&
844 		dev_err(vcap->dev, "mbus code 0x%x do not match capture device format (0x%x)\n",
845 			vcap->format.pixelformat, source_fmt.format.code);
861 	struct dcmipp_bytecap_device *vcap;
868 	vcap = kzalloc(sizeof(*vcap), GFP_KERNEL);
869 	if (!vcap)
873 	vcap->ved.pads = dcmipp_pads_init(1, &pad_flag);
874 	if (IS_ERR(vcap->ved.pads)) {
875 		ret = PTR_ERR(vcap->ved.pads);
880 	vcap->vdev.entity.name = entity_name;
881 	vcap->vdev.entity.function = MEDIA_ENT_F_IO_V4L;
882 	vcap->vdev.entity.ops = &dcmipp_bytecap_entity_ops;
883 	ret = media_entity_pads_init(&vcap->vdev.entity, 1, vcap->ved.pads);
888 	mutex_init(&vcap->lock);
891 	q = &vcap->queue;
894 	q->lock = &vcap->lock;
895 	q->drv_priv = vcap;
918 	INIT_LIST_HEAD(&vcap->buffers);
919 	spin_lock_init(&vcap->irqlock);
922 	vcap->format = fmt_default;
925 	vcap->ved.ent = &vcap->vdev.entity;
926 	vcap->ved.handler = dcmipp_bytecap_irq_callback;
927 	vcap->ved.thread_fn = dcmipp_bytecap_irq_thread;
928 	vcap->dev = dev;
929 	vcap->regs = regs;
932 	vdev = &vcap->vdev;
938 	vdev->lock = &vcap->lock;
942 	video_set_drvdata(vdev, &vcap->ved);
948 			vcap->vdev.name, ret);
952 	return &vcap->ved;
955 	media_entity_cleanup(&vcap->vdev.entity);
957 	mutex_destroy(&vcap->lock);
959 	dcmipp_pads_cleanup(vcap->ved.pads);
961 	kfree(vcap);