/* * Driver for Renesas R-Car VIN * * Copyright (C) 2016 Renesas Electronics Corp. * Copyright (C) 2011-2013 Renesas Solutions Corp. * Copyright (C) 2013 Cogent Embedded, Inc., * Copyright (C) 2008 Magnus Damm * * Based on the soc-camera rcar_vin driver * * This program is free software; you can redistribute it and/or modify it * under the terms of the GNU General Public License as published by the * Free Software Foundation; either version 2 of the License, or (at your * option) any later version. */ #include #include #include #include #include #include #include #include #include "rcar-vin.h" /* ----------------------------------------------------------------------------- * Async notifier */ #define notifier_to_vin(n) container_of(n, struct rvin_dev, notifier) static int rvin_find_pad(struct v4l2_subdev *sd, int direction) { unsigned int pad; if (sd->entity.num_pads <= 1) return 0; for (pad = 0; pad < sd->entity.num_pads; pad++) if (sd->entity.pads[pad].flags & direction) return pad; return -EINVAL; } /* The vin lock should be held when calling the subdevice attach and detach */ static int rvin_digital_subdevice_attach(struct rvin_dev *vin, struct v4l2_subdev *subdev) { struct v4l2_subdev_mbus_code_enum code = { .which = V4L2_SUBDEV_FORMAT_ACTIVE, }; int ret; /* Find source and sink pad of remote subdevice */ ret = rvin_find_pad(subdev, MEDIA_PAD_FL_SOURCE); if (ret < 0) return ret; vin->digital->source_pad = ret; ret = rvin_find_pad(subdev, MEDIA_PAD_FL_SINK); vin->digital->sink_pad = ret < 0 ? 0 : ret; /* Find compatible subdevices mbus format */ vin->mbus_code = 0; code.index = 0; code.pad = vin->digital->source_pad; while (!vin->mbus_code && !v4l2_subdev_call(subdev, pad, enum_mbus_code, NULL, &code)) { code.index++; switch (code.code) { case MEDIA_BUS_FMT_YUYV8_1X16: case MEDIA_BUS_FMT_UYVY8_2X8: case MEDIA_BUS_FMT_UYVY10_2X10: case MEDIA_BUS_FMT_RGB888_1X24: vin->mbus_code = code.code; vin_dbg(vin, "Found media bus format for %s: %d\n", subdev->name, vin->mbus_code); break; default: break; } } if (!vin->mbus_code) { vin_err(vin, "Unsupported media bus format for %s\n", subdev->name); return -EINVAL; } /* Read tvnorms */ ret = v4l2_subdev_call(subdev, video, g_tvnorms, &vin->vdev.tvnorms); if (ret < 0 && ret != -ENOIOCTLCMD && ret != -ENODEV) return ret; /* Read standard */ vin->std = V4L2_STD_UNKNOWN; ret = v4l2_subdev_call(subdev, video, g_std, &vin->std); if (ret < 0 && ret != -ENOIOCTLCMD) return ret; /* Add the controls */ ret = v4l2_ctrl_handler_init(&vin->ctrl_handler, 16); if (ret < 0) return ret; ret = v4l2_ctrl_add_handler(&vin->ctrl_handler, subdev->ctrl_handler, NULL); if (ret < 0) { v4l2_ctrl_handler_free(&vin->ctrl_handler); return ret; } vin->vdev.ctrl_handler = &vin->ctrl_handler; vin->digital->subdev = subdev; return 0; } static void rvin_digital_subdevice_detach(struct rvin_dev *vin) { rvin_v4l2_unregister(vin); v4l2_ctrl_handler_free(&vin->ctrl_handler); vin->vdev.ctrl_handler = NULL; vin->digital->subdev = NULL; } static int rvin_digital_notify_complete(struct v4l2_async_notifier *notifier) { struct rvin_dev *vin = notifier_to_vin(notifier); int ret; ret = v4l2_device_register_subdev_nodes(&vin->v4l2_dev); if (ret < 0) { vin_err(vin, "Failed to register subdev nodes\n"); return ret; } return rvin_v4l2_register(vin); } static void rvin_digital_notify_unbind(struct v4l2_async_notifier *notifier, struct v4l2_subdev *subdev, struct v4l2_async_subdev *asd) { struct rvin_dev *vin = notifier_to_vin(notifier); vin_dbg(vin, "unbind digital subdev %s\n", subdev->name); mutex_lock(&vin->lock); rvin_digital_subdevice_detach(vin); mutex_unlock(&vin->lock); } static int rvin_digital_notify_bound(struct v4l2_async_notifier *notifier, struct v4l2_subdev *subdev, struct v4l2_async_subdev *asd) { struct rvin_dev *vin = notifier_to_vin(notifier); int ret; mutex_lock(&vin->lock); ret = rvin_digital_subdevice_attach(vin, subdev); mutex_unlock(&vin->lock); if (ret) return ret; v4l2_set_subdev_hostdata(subdev, vin); vin_dbg(vin, "bound subdev %s source pad: %u sink pad: %u\n", subdev->name, vin->digital->source_pad, vin->digital->sink_pad); return 0; } static const struct v4l2_async_notifier_operations rvin_digital_notify_ops = { .bound = rvin_digital_notify_bound, .unbind = rvin_digital_notify_unbind, .complete = rvin_digital_notify_complete, }; static int rvin_digital_parse_v4l2(struct device *dev, struct v4l2_fwnode_endpoint *vep, struct v4l2_async_subdev *asd) { struct rvin_dev *vin = dev_get_drvdata(dev); struct rvin_graph_entity *rvge = container_of(asd, struct rvin_graph_entity, asd); if (vep->base.port || vep->base.id) return -ENOTCONN; vin->mbus_cfg.type = vep->bus_type; switch (vin->mbus_cfg.type) { case V4L2_MBUS_PARALLEL: vin_dbg(vin, "Found PARALLEL media bus\n"); vin->mbus_cfg.flags = vep->bus.parallel.flags; break; case V4L2_MBUS_BT656: vin_dbg(vin, "Found BT656 media bus\n"); vin->mbus_cfg.flags = 0; break; default: vin_err(vin, "Unknown media bus type\n"); return -EINVAL; } vin->digital = rvge; return 0; } static int rvin_digital_graph_init(struct rvin_dev *vin) { int ret; ret = v4l2_async_notifier_parse_fwnode_endpoints( vin->dev, &vin->notifier, sizeof(struct rvin_graph_entity), rvin_digital_parse_v4l2); if (ret) return ret; if (!vin->digital) return -ENODEV; vin_dbg(vin, "Found digital subdevice %pOF\n", to_of_node(vin->digital->asd.match.fwnode)); vin->notifier.ops = &rvin_digital_notify_ops; ret = v4l2_async_notifier_register(&vin->v4l2_dev, &vin->notifier); if (ret < 0) { vin_err(vin, "Notifier registration failed\n"); return ret; } return 0; } /* ----------------------------------------------------------------------------- * Platform Device Driver */ static const struct rvin_info rcar_info_h1 = { .model = RCAR_H1, .max_width = 2048, .max_height = 2048, }; static const struct rvin_info rcar_info_m1 = { .model = RCAR_M1, .max_width = 2048, .max_height = 2048, }; static const struct rvin_info rcar_info_gen2 = { .model = RCAR_GEN2, .max_width = 2048, .max_height = 2048, }; static const struct of_device_id rvin_of_id_table[] = { { .compatible = "renesas,vin-r8a7778", .data = &rcar_info_m1, }, { .compatible = "renesas,vin-r8a7779", .data = &rcar_info_h1, }, { .compatible = "renesas,vin-r8a7790", .data = &rcar_info_gen2, }, { .compatible = "renesas,vin-r8a7791", .data = &rcar_info_gen2, }, { .compatible = "renesas,vin-r8a7793", .data = &rcar_info_gen2, }, { .compatible = "renesas,vin-r8a7794", .data = &rcar_info_gen2, }, { .compatible = "renesas,rcar-gen2-vin", .data = &rcar_info_gen2, }, { /* Sentinel */ }, }; MODULE_DEVICE_TABLE(of, rvin_of_id_table); static int rcar_vin_probe(struct platform_device *pdev) { struct rvin_dev *vin; struct resource *mem; int irq, ret; vin = devm_kzalloc(&pdev->dev, sizeof(*vin), GFP_KERNEL); if (!vin) return -ENOMEM; vin->dev = &pdev->dev; vin->info = of_device_get_match_data(&pdev->dev); mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); if (mem == NULL) return -EINVAL; vin->base = devm_ioremap_resource(vin->dev, mem); if (IS_ERR(vin->base)) return PTR_ERR(vin->base); irq = platform_get_irq(pdev, 0); if (irq < 0) return irq; ret = rvin_dma_register(vin, irq); if (ret) return ret; platform_set_drvdata(pdev, vin); ret = rvin_digital_graph_init(vin); if (ret < 0) goto error; pm_suspend_ignore_children(&pdev->dev, true); pm_runtime_enable(&pdev->dev); return 0; error: rvin_dma_unregister(vin); v4l2_async_notifier_cleanup(&vin->notifier); return ret; } static int rcar_vin_remove(struct platform_device *pdev) { struct rvin_dev *vin = platform_get_drvdata(pdev); pm_runtime_disable(&pdev->dev); rvin_v4l2_unregister(vin); v4l2_async_notifier_unregister(&vin->notifier); v4l2_async_notifier_cleanup(&vin->notifier); v4l2_ctrl_handler_free(&vin->ctrl_handler); rvin_dma_unregister(vin); return 0; } static struct platform_driver rcar_vin_driver = { .driver = { .name = "rcar-vin", .of_match_table = rvin_of_id_table, }, .probe = rcar_vin_probe, .remove = rcar_vin_remove, }; module_platform_driver(rcar_vin_driver); MODULE_AUTHOR("Niklas Söderlund "); MODULE_DESCRIPTION("Renesas R-Car VIN camera host driver"); MODULE_LICENSE("GPL v2");