[PATCH v7 5/8] [media] vcodec: mediatek: Add Mediatek V4L2 Video Encoder Driver
tiffany lin
tiffany.lin at mediatek.com
Mon Apr 25 00:02:48 PDT 2016
Hi Wucheng,
On Mon, 2016-04-25 at 13:42 +0800, Wu-Cheng Li (李務誠) wrote:
> > >
> > > ...
> > >
> > > > +static int fops_vcodec_open(struct file *file)
> > > > +{
> > > > + struct video_device *vfd = video_devdata(file);
> > > > + struct mtk_vcodec_dev *dev = video_drvdata(file);
> > > > + struct mtk_vcodec_ctx *ctx = NULL;
> > > > + int ret = 0;
> > > > +
> > > > + if (dev->instance_mask == ~0UL) {
> > > > + /* ffz Undefined if no zero exists, err handling here */
> > > > + mtk_v4l2_err("Too many open contexts");
> > > > + ret = -EBUSY;
> > > > + goto err_alloc;
> > >
> > > I'm not happy seeing this here. You should always be able to open the device.
> > > I would expect to see a check like this in e.g. start_streaming, since that's
> > > where you start to use the hardware for real, and checking if you have enough
> > > resources there is perfectly fine.
> > >
> > > If this is an artificial constraint (i.e. not based on a real hardware limitation),
> > > then it should perhaps just be dropped. Such constraints tend to be pointless.
> > > If you want to encode 20 streams simultaneously, then why not? It will be very
> > > slow, but that's not this driver's problem :-)
> > >
> > We use ffz to get instance index.
> > This only make sure that instance id is correct since in ffz
> > description,
> > "Undefined if no zero exists, so code should check against ~0UL first."
> > In this case, it may not be able to move to start_streaming.
> > Any suggestion that how we do this?
> The instance index is only used for printing the debug information.
> No? If that's the case, you can remove instance index and print
> mtk_vcodec_ctx address for debugging.
> >
Got it, will remove it in next version.
best regards,
Tiffany
> >
> > > > + }
> > > > +
> > > > + mutex_lock(&dev->dev_mutex);
> > > > +
> > > > + ctx = devm_kzalloc(&dev->plat_dev->dev, sizeof(*ctx), GFP_KERNEL);
> > >
> > > Why is this a devm_ call? It is not managed by a device, so it seems to me that
> > > a regular kzalloc is good enough here.
> > >
> > > > + if (!ctx) {
> > > > + ret = -ENOMEM;
> > > > + goto err_alloc;
> > > > + }
> > > > +
> > > > + ctx->idx = ffz(dev->instance_mask);
> > > > + v4l2_fh_init(&ctx->fh, video_devdata(file));
> > > > + file->private_data = &ctx->fh;
> > > > + v4l2_fh_add(&ctx->fh);
> > > > + INIT_LIST_HEAD(&ctx->list);
> > > > + ctx->dev = dev;
> > > > + init_waitqueue_head(&ctx->queue);
> > > > +
> > > > + if (vfd == dev->vfd_enc) {
> > > > + ctx->type = MTK_INST_ENCODER;
> > > > + ret = mtk_vcodec_enc_ctrls_setup(ctx);
> > > > + if (ret) {
> > > > + mtk_v4l2_err("Failed to setup controls() (%d)",
> > > > + ret);
> > > > + goto err_ctrls_setup;
> > > > + }
> > > > + ctx->m2m_ctx = v4l2_m2m_ctx_init(dev->m2m_dev_enc, ctx,
> > > > + &mtk_vcodec_enc_queue_init);
> > > > + if (IS_ERR(ctx->m2m_ctx)) {
> > > > + ret = PTR_ERR(ctx->m2m_ctx);
> > > > + mtk_v4l2_err("Failed to v4l2_m2m_ctx_init() (%d)",
> > > > + ret);
> > > > + goto err_m2m_ctx_init;
> > > > + }
> > > > + mtk_vcodec_enc_set_default_params(ctx);
> > > > + } else {
> > > > + mtk_v4l2_err("Invalid vfd !");
> > >
> > > This shouldn't be possible at all. I would just drop the 'if (vfd == dev->vfd_enc)' check.
> > Got it, will remove in next version.
> >
> > >
> > > > + ret = -ENOENT;
> > > > + goto err_m2m_ctx_init;
> > > > + }
> > > > +
> > > > + if (v4l2_fh_is_singular(&ctx->fh)) {
> > > > + ret = vpu_load_firmware(dev->vpu_plat_dev);
> > > > + if (ret < 0) {
> > > > + /*
> > > > + * Return 0 if downloading firmware successfully,
> > > > + * otherwise it is failed
> > > > + */
> > > > + mtk_v4l2_err("vpu_load_firmware failed!");
> > > > + goto err_load_fw;
> > > > + }
> > >
> > > The fw load seems to be a one-time thing, but here it is done every time
> > > someone opens the device and nobody else had it open.
> > >
> > > If this is a one time thing, then using a bool 'loaded_fw' makes more sense.
> > >
> > More than one module use vpu firmware, encoder/decoder/mdp...etc.
> > If this is first encode instance, we need to check and load vpu
> > firmware.
> > vpu_load_firmware will check and load firmware when necessary.
> >
> > best regards,
> > Tiffany
> > > > +
> > > > + dev->enc_capability =
> > > > + vpu_get_venc_hw_capa(dev->vpu_plat_dev);
> > > > + mtk_v4l2_debug(0, "encoder capability %x", dev->enc_capability);
> > > > + }
> > > > +
> > > > + mtk_v4l2_debug(2, "Create instance [%d]@%p m2m_ctx=%p ",
> > > > + ctx->idx, ctx, ctx->m2m_ctx);
> > > > + set_bit(ctx->idx, &dev->instance_mask);
> > > > + dev->num_instances++;
> > > > + list_add(&ctx->list, &dev->ctx_list);
> > > > +
> > > > + mutex_unlock(&dev->dev_mutex);
> > > > + mtk_v4l2_debug(0, "%s encoder [%d]", dev_name(&dev->plat_dev->dev),
> > > > + ctx->idx);
> > > > + return ret;
> > > > +
> > > > + /* Deinit when failure occurred */
> > > > +err_load_fw:
> > > > + v4l2_m2m_ctx_release(ctx->m2m_ctx);
> > > > +err_m2m_ctx_init:
> > > > + v4l2_ctrl_handler_free(&ctx->ctrl_hdl);
> > > > +err_ctrls_setup:
> > > > + v4l2_fh_del(&ctx->fh);
> > > > + v4l2_fh_exit(&ctx->fh);
> > > > + devm_kfree(&dev->plat_dev->dev, ctx);
> > > > +err_alloc:
> > > > + mutex_unlock(&dev->dev_mutex);
> > > > +
> > > > + return ret;
> > > > +}
> > > > +
> > > > +static int fops_vcodec_release(struct file *file)
> > > > +{
> > > > + struct mtk_vcodec_dev *dev = video_drvdata(file);
> > > > + struct mtk_vcodec_ctx *ctx = fh_to_ctx(file->private_data);
> > > > +
> > > > + mtk_v4l2_debug(1, "[%d] encoder", ctx->idx);
> > > > + mutex_lock(&dev->dev_mutex);
> > > > +
> > > > + mtk_vcodec_enc_release(ctx);
> > > > + v4l2_fh_del(&ctx->fh);
> > > > + v4l2_fh_exit(&ctx->fh);
> > > > + v4l2_ctrl_handler_free(&ctx->ctrl_hdl);
> > > > + v4l2_m2m_ctx_release(ctx->m2m_ctx);
> > > > +
> > > > + list_del_init(&ctx->list);
> > > > + dev->num_instances--;
> > > > + clear_bit(ctx->idx, &dev->instance_mask);
> > > > + devm_kfree(&dev->plat_dev->dev, ctx);
> > > > + mutex_unlock(&dev->dev_mutex);
> > > > + return 0;
> > > > +}
> > > > +
> > > > +static const struct v4l2_file_operations mtk_vcodec_fops = {
> > > > + .owner = THIS_MODULE,
> > > > + .open = fops_vcodec_open,
> > > > + .release = fops_vcodec_release,
> > > > + .poll = v4l2_m2m_fop_poll,
> > > > + .unlocked_ioctl = video_ioctl2,
> > > > + .mmap = v4l2_m2m_fop_mmap,
> > > > +};
> > > > +
> > > > +static int mtk_vcodec_probe(struct platform_device *pdev)
> > > > +{
> > > > + struct mtk_vcodec_dev *dev;
> > > > + struct video_device *vfd_enc;
> > > > + struct resource *res;
> > > > + int i, j, ret;
> > > > + DEFINE_DMA_ATTRS(attrs);
> > > > +
> > > > + dev = devm_kzalloc(&pdev->dev, sizeof(*dev), GFP_KERNEL);
> > > > + if (!dev)
> > > > + return -ENOMEM;
> > > > +
> > > > + INIT_LIST_HEAD(&dev->ctx_list);
> > > > + dev->plat_dev = pdev;
> > > > +
> > > > + dev->vpu_plat_dev = vpu_get_plat_device(dev->plat_dev);
> > > > + if (dev->vpu_plat_dev == NULL) {
> > > > + mtk_v4l2_err("[VPU] vpu device in not ready");
> > > > + return -EPROBE_DEFER;
> > > > + }
> > > > +
> > > > + vpu_wdt_reg_handler(dev->vpu_plat_dev, mtk_vcodec_enc_reset_handler,
> > > > + dev, VPU_RST_ENC);
> > > > +
> > > > + ret = mtk_vcodec_init_enc_pm(dev);
> > > > + if (ret < 0) {
> > > > + dev_err(&pdev->dev, "Failed to get mt vcodec clock source!");
> > > > + return ret;
> > > > + }
> > > > +
> > > > + for (i = VENC_SYS, j = 0; i < NUM_MAX_VCODEC_REG_BASE; i++, j++) {
> > > > + res = platform_get_resource(pdev, IORESOURCE_MEM, j);
> > > > + if (res == NULL) {
> > > > + dev_err(&pdev->dev, "get memory resource failed.");
> > > > + ret = -ENXIO;
> > > > + goto err_res;
> > > > + }
> > > > + dev->reg_base[i] = devm_ioremap_resource(&pdev->dev, res);
> > > > + if (IS_ERR(dev->reg_base[i])) {
> > > > + dev_err(&pdev->dev,
> > > > + "devm_ioremap_resource %d failed.", i);
> > > > + ret = PTR_ERR(dev->reg_base[i]);
> > > > + goto err_res;
> > > > + }
> > > > + mtk_v4l2_debug(2, "reg[%d] base=0x%p", i, dev->reg_base[i]);
> > > > + }
> > > > +
> > > > + res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
> > > > + if (res == NULL) {
> > > > + dev_err(&pdev->dev, "failed to get irq resource");
> > > > + ret = -ENOENT;
> > > > + goto err_res;
> > > > + }
> > > > +
> > > > + dev->enc_irq = platform_get_irq(pdev, 0);
> > > > + ret = devm_request_irq(&pdev->dev, dev->enc_irq,
> > > > + mtk_vcodec_enc_irq_handler,
> > > > + 0, pdev->name, dev);
> > > > + if (ret) {
> > > > + dev_err(&pdev->dev, "Failed to install dev->enc_irq %d (%d)",
> > > > + dev->enc_irq,
> > > > + ret);
> > > > + ret = -EINVAL;
> > > > + goto err_res;
> > > > + }
> > > > +
> > > > + dev->enc_lt_irq = platform_get_irq(pdev, 1);
> > > > + ret = devm_request_irq(&pdev->dev,
> > > > + dev->enc_lt_irq, mtk_vcodec_enc_lt_irq_handler,
> > > > + 0, pdev->name, dev);
> > > > + if (ret) {
> > > > + dev_err(&pdev->dev,
> > > > + "Failed to install dev->enc_lt_irq %d (%d)",
> > > > + dev->enc_lt_irq, ret);
> > > > + ret = -EINVAL;
> > > > + goto err_res;
> > > > + }
> > > > +
> > > > + disable_irq(dev->enc_irq);
> > > > + disable_irq(dev->enc_lt_irq); /* VENC_LT */
> > > > + mutex_init(&dev->enc_mutex);
> > > > + mutex_init(&dev->dev_mutex);
> > > > + spin_lock_init(&dev->irqlock);
> > > > +
> > > > + snprintf(dev->v4l2_dev.name, sizeof(dev->v4l2_dev.name), "%s",
> > > > + "[MTK_V4L2_VENC]");
> > > > +
> > > > + ret = v4l2_device_register(&pdev->dev, &dev->v4l2_dev);
> > > > + if (ret) {
> > > > + mtk_v4l2_err("v4l2_device_register err=%d", ret);
> > > > + goto err_res;
> > > > + }
> > > > +
> > > > + init_waitqueue_head(&dev->queue);
> > > > +
> > > > + /* allocate video device for encoder and register it */
> > > > + vfd_enc = video_device_alloc();
> > > > + if (!vfd_enc) {
> > > > + mtk_v4l2_err("Failed to allocate video device");
> > > > + ret = -ENOMEM;
> > > > + goto err_enc_alloc;
> > > > + }
> > > > + vfd_enc->fops = &mtk_vcodec_fops;
> > > > + vfd_enc->ioctl_ops = &mtk_venc_ioctl_ops;
> > > > + vfd_enc->release = video_device_release;
> > > > + vfd_enc->lock = &dev->dev_mutex;
> > > > + vfd_enc->v4l2_dev = &dev->v4l2_dev;
> > > > + vfd_enc->vfl_dir = VFL_DIR_M2M;
> > > > + vfd_enc->device_caps = V4L2_CAP_VIDEO_M2M_MPLANE |
> > > > + V4L2_CAP_STREAMING;
> > > > +
> > > > + snprintf(vfd_enc->name, sizeof(vfd_enc->name), "%s",
> > > > + MTK_VCODEC_ENC_NAME);
> > > > + video_set_drvdata(vfd_enc, dev);
> > > > + dev->vfd_enc = vfd_enc;
> > > > + platform_set_drvdata(pdev, dev);
> > > > +
> > > > + dev->alloc_ctx = vb2_dma_contig_init_ctx(&pdev->dev);
> > > > + if (IS_ERR(dev->alloc_ctx)) {
> > > > + dev->alloc_ctx = NULL;
> > > > + mtk_v4l2_err("Failed to alloc vb2 dma context 0");
> > > > + ret = PTR_ERR(dev->alloc_ctx);
> > > > + goto err_vb2_ctx_init;
> > > > + }
> > > > +
> > > > + dev->m2m_dev_enc = v4l2_m2m_init(&mtk_venc_m2m_ops);
> > > > + if (IS_ERR(dev->m2m_dev_enc)) {
> > > > + mtk_v4l2_err("Failed to init mem2mem enc device");
> > > > + ret = PTR_ERR(dev->m2m_dev_enc);
> > > > + goto err_enc_mem_init;
> > > > + }
> > > > +
> > > > + dev->encode_workqueue =
> > > > + alloc_ordered_workqueue(MTK_VCODEC_ENC_NAME,
> > > > + WQ_MEM_RECLAIM |
> > > > + WQ_FREEZABLE);
> > > > + if (!dev->encode_workqueue) {
> > > > + mtk_v4l2_err("Failed to create encode workqueue");
> > > > + ret = -EINVAL;
> > > > + goto err_event_workq;
> > > > + }
> > > > +
> > > > + ret = video_register_device(vfd_enc, VFL_TYPE_GRABBER, 1);
> > > > + if (ret) {
> > > > + mtk_v4l2_err("Failed to register video device");
> > > > + goto err_enc_reg;
> > > > + }
> > > > +
> > > > + /* Avoid the iommu eat big hunks */
> > > > + dma_set_attr(DMA_ATTR_ALLOC_SINGLE_PAGES, &attrs);
> > > > +
> > > > + mtk_v4l2_debug(0, "encoder registered as /dev/video%d",
> > > > + vfd_enc->num);
> > > > +
> > > > + return 0;
> > > > +
> > > > +err_enc_reg:
> > > > + destroy_workqueue(dev->encode_workqueue);
> > > > +err_event_workq:
> > > > + v4l2_m2m_release(dev->m2m_dev_enc);
> > > > +err_enc_mem_init:
> > > > + vb2_dma_contig_cleanup_ctx(dev->alloc_ctx);
> > > > +err_vb2_ctx_init:
> > > > + video_unregister_device(vfd_enc);
> > > > +err_enc_alloc:
> > > > + v4l2_device_unregister(&dev->v4l2_dev);
> > > > +err_res:
> > > > + mtk_vcodec_release_enc_pm(dev);
> > > > + return ret;
> > > > +}
> > > > +
> > > > +static const struct of_device_id mtk_vcodec_enc_match[] = {
> > > > + {.compatible = "mediatek,mt8173-vcodec-enc",},
> > > > + {},
> > > > +};
> > > > +MODULE_DEVICE_TABLE(of, mtk_vcodec_enc_match);
> > > > +
> > > > +static int mtk_vcodec_enc_remove(struct platform_device *pdev)
> > > > +{
> > > > + struct mtk_vcodec_dev *dev = platform_get_drvdata(pdev);
> > > > +
> > > > + mtk_v4l2_debug_enter();
> > > > + flush_workqueue(dev->encode_workqueue);
> > > > + destroy_workqueue(dev->encode_workqueue);
> > > > + if (dev->m2m_dev_enc)
> > > > + v4l2_m2m_release(dev->m2m_dev_enc);
> > > > + if (dev->alloc_ctx)
> > > > + vb2_dma_contig_cleanup_ctx(dev->alloc_ctx);
> > > > +
> > > > + if (dev->vfd_enc)
> > > > + video_unregister_device(dev->vfd_enc);
> > > > +
> > > > + v4l2_device_unregister(&dev->v4l2_dev);
> > > > + mtk_vcodec_release_enc_pm(dev);
> > > > + return 0;
> > > > +}
> > > > +
> > > > +static struct platform_driver mtk_vcodec_enc_driver = {
> > > > + .probe = mtk_vcodec_probe,
> > > > + .remove = mtk_vcodec_enc_remove,
> > > > + .driver = {
> > > > + .name = MTK_VCODEC_ENC_NAME,
> > > > + .owner = THIS_MODULE,
> > > > + .of_match_table = mtk_vcodec_enc_match,
> > > > + },
> > > > +};
> > > > +
> > > > +module_platform_driver(mtk_vcodec_enc_driver);
> > > > +
> > > > +
> > > > +MODULE_LICENSE("GPL v2");
> > > > +MODULE_DESCRIPTION("Mediatek video codec V4L2 encoder driver");
> > >
> > > Regards,
> > >
> > > Hans
> >
> >
> > --
> > To unsubscribe from this list: send the line "unsubscribe linux-media" in
> > the body of a message to majordomo at vger.kernel.org
> > More majordomo info at http://vger.kernel.org/majordomo-info.html
More information about the linux-arm-kernel
mailing list