53 xvip_graph_find_entity(struct xvip_composite_device *xdev,  in xvip_graph_find_entity()  argument
59 		&xdev->notifier.done_list,  in xvip_graph_find_entity()
60 		&xdev->notifier.waiting_list  in xvip_graph_find_entity()
75 static int xvip_graph_build_one(struct xvip_composite_device *xdev,  in xvip_graph_build_one()  argument
88 	dev_dbg(xdev->dev, "creating links for entity %s\n", local->name);  in xvip_graph_build_one()
97 		dev_dbg(xdev->dev, "processing endpoint %p\n", ep);  in xvip_graph_build_one()
101 			dev_err(xdev->dev, "failed to parse link for %p\n",  in xvip_graph_build_one()
110 			dev_err(xdev->dev, "invalid port number %u for %p\n",  in xvip_graph_build_one()
120 			dev_dbg(xdev->dev, "skipping sink port %p:%u\n",  in xvip_graph_build_one()
127 		if (link.remote_node == of_fwnode_handle(xdev->dev->of_node)) {  in xvip_graph_build_one()
128 			dev_dbg(xdev->dev, "skipping DMA port %p:%u\n",  in xvip_graph_build_one()
135 		ent = xvip_graph_find_entity(xdev, link.remote_node);  in xvip_graph_build_one()
137 			dev_err(xdev->dev, "no entity found for %p\n",  in xvip_graph_build_one()
147 			dev_err(xdev->dev, "invalid port number %u on %p\n",  in xvip_graph_build_one()
159 		dev_dbg(xdev->dev, "creating %s:%u -> %s:%u link\n",  in xvip_graph_build_one()
167 			dev_err(xdev->dev,  in xvip_graph_build_one()
180 xvip_graph_find_dma(struct xvip_composite_device *xdev, unsigned int port)  in xvip_graph_find_dma()  argument
184 	list_for_each_entry(dma, &xdev->dmas, list) {  in xvip_graph_find_dma()
192 static int xvip_graph_build_dma(struct xvip_composite_device *xdev)  in xvip_graph_build_dma()  argument
195 	struct device_node *node = xdev->dev->of_node;  in xvip_graph_build_dma()
206 	dev_dbg(xdev->dev, "creating links for DMA engines\n");  in xvip_graph_build_dma()
214 		dev_dbg(xdev->dev, "processing endpoint %pOF\n", ep);  in xvip_graph_build_dma()
218 			dev_err(xdev->dev, "failed to parse link for %pOF\n",  in xvip_graph_build_dma()
224 		dma = xvip_graph_find_dma(xdev, link.local_port);  in xvip_graph_build_dma()
226 			dev_err(xdev->dev, "no DMA engine found for port %u\n",  in xvip_graph_build_dma()
233 		dev_dbg(xdev->dev, "creating link for DMA engine %s\n",  in xvip_graph_build_dma()
237 		ent = xvip_graph_find_entity(xdev, link.remote_node);  in xvip_graph_build_dma()
239 			dev_err(xdev->dev, "no entity found for %pOF\n",  in xvip_graph_build_dma()
247 			dev_err(xdev->dev, "invalid port number %u on %pOF\n",  in xvip_graph_build_dma()
270 		dev_dbg(xdev->dev, "creating %s:%u -> %s:%u link\n",  in xvip_graph_build_dma()
278 			dev_err(xdev->dev,  in xvip_graph_build_dma()
292 	struct xvip_composite_device *xdev =  in xvip_graph_notify_complete()  local
298 	dev_dbg(xdev->dev, "notify complete, all subdevs registered\n");  in xvip_graph_notify_complete()
301 	list_for_each_entry(asd, &xdev->notifier.done_list, asc_entry) {  in xvip_graph_notify_complete()
303 		ret = xvip_graph_build_one(xdev, entity);  in xvip_graph_notify_complete()
309 	ret = xvip_graph_build_dma(xdev);  in xvip_graph_notify_complete()
313 	ret = v4l2_device_register_subdev_nodes(&xdev->v4l2_dev);  in xvip_graph_notify_complete()
315 		dev_err(xdev->dev, "failed to register subdev nodes\n");  in xvip_graph_notify_complete()
317 	return media_device_register(&xdev->media_dev);  in xvip_graph_notify_complete()
337 static int xvip_graph_parse_one(struct xvip_composite_device *xdev,  in xvip_graph_parse_one()  argument
344 	dev_dbg(xdev->dev, "parsing node %p\n", fwnode);  in xvip_graph_parse_one()
353 		dev_dbg(xdev->dev, "handling endpoint %p\n", ep);  in xvip_graph_parse_one()
364 		if (remote == of_fwnode_handle(xdev->dev->of_node) ||  in xvip_graph_parse_one()
365 		    xvip_graph_find_entity(xdev, remote)) {  in xvip_graph_parse_one()
370 		xge = v4l2_async_nf_add_fwnode(&xdev->notifier, remote,  in xvip_graph_parse_one()
382 	v4l2_async_nf_cleanup(&xdev->notifier);  in xvip_graph_parse_one()
387 static int xvip_graph_parse(struct xvip_composite_device *xdev)  in xvip_graph_parse()  argument
399 	ret = xvip_graph_parse_one(xdev, of_fwnode_handle(xdev->dev->of_node));  in xvip_graph_parse()
403 	list_for_each_entry(asd, &xdev->notifier.waiting_list, asc_entry) {  in xvip_graph_parse()
405 		ret = xvip_graph_parse_one(xdev, entity->asd.match.fwnode);  in xvip_graph_parse()
407 			v4l2_async_nf_cleanup(&xdev->notifier);  in xvip_graph_parse()
415 static int xvip_graph_dma_init_one(struct xvip_composite_device *xdev,  in xvip_graph_dma_init_one()  argument
437 	dma = devm_kzalloc(xdev->dev, sizeof(*dma), GFP_KERNEL);  in xvip_graph_dma_init_one()
441 	ret = xvip_dma_init(xdev, dma, type, index);  in xvip_graph_dma_init_one()
443 		dev_err(xdev->dev, "%pOF initialization failed\n", node);  in xvip_graph_dma_init_one()
447 	list_add_tail(&dma->list, &xdev->dmas);  in xvip_graph_dma_init_one()
449 	xdev->v4l2_caps |= type == V4L2_BUF_TYPE_VIDEO_CAPTURE  in xvip_graph_dma_init_one()
455 static int xvip_graph_dma_init(struct xvip_composite_device *xdev)  in xvip_graph_dma_init()  argument
461 	ports = of_get_child_by_name(xdev->dev->of_node, "ports");  in xvip_graph_dma_init()
463 		dev_err(xdev->dev, "ports node not present\n");  in xvip_graph_dma_init()
468 		ret = xvip_graph_dma_init_one(xdev, port);  in xvip_graph_dma_init()
479 static void xvip_graph_cleanup(struct xvip_composite_device *xdev)  in xvip_graph_cleanup()  argument
484 	v4l2_async_nf_unregister(&xdev->notifier);  in xvip_graph_cleanup()
485 	v4l2_async_nf_cleanup(&xdev->notifier);  in xvip_graph_cleanup()
487 	list_for_each_entry_safe(dma, dmap, &xdev->dmas, list) {  in xvip_graph_cleanup()
493 static int xvip_graph_init(struct xvip_composite_device *xdev)  in xvip_graph_init()  argument
498 	ret = xvip_graph_dma_init(xdev);  in xvip_graph_init()
500 		dev_err(xdev->dev, "DMA initialization failed\n");  in xvip_graph_init()
504 	v4l2_async_nf_init(&xdev->notifier, &xdev->v4l2_dev);  in xvip_graph_init()
507 	ret = xvip_graph_parse(xdev);  in xvip_graph_init()
509 		dev_err(xdev->dev, "graph parsing failed\n");  in xvip_graph_init()
513 	if (list_empty(&xdev->notifier.waiting_list)) {  in xvip_graph_init()
514 		dev_err(xdev->dev, "no subdev found in graph\n");  in xvip_graph_init()
520 	xdev->notifier.ops = &xvip_graph_notify_ops;  in xvip_graph_init()
522 	ret = v4l2_async_nf_register(&xdev->notifier);  in xvip_graph_init()
524 		dev_err(xdev->dev, "notifier registration failed\n");  in xvip_graph_init()
532 		xvip_graph_cleanup(xdev);  in xvip_graph_init()
541 static void xvip_composite_v4l2_cleanup(struct xvip_composite_device *xdev)  in xvip_composite_v4l2_cleanup()  argument
543 	v4l2_device_unregister(&xdev->v4l2_dev);  in xvip_composite_v4l2_cleanup()
544 	media_device_unregister(&xdev->media_dev);  in xvip_composite_v4l2_cleanup()
545 	media_device_cleanup(&xdev->media_dev);  in xvip_composite_v4l2_cleanup()
548 static int xvip_composite_v4l2_init(struct xvip_composite_device *xdev)  in xvip_composite_v4l2_init()  argument
552 	xdev->media_dev.dev = xdev->dev;  in xvip_composite_v4l2_init()
553 	strscpy(xdev->media_dev.model, "Xilinx Video Composite Device",  in xvip_composite_v4l2_init()
554 		sizeof(xdev->media_dev.model));  in xvip_composite_v4l2_init()
555 	xdev->media_dev.hw_revision = 0;  in xvip_composite_v4l2_init()
557 	media_device_init(&xdev->media_dev);  in xvip_composite_v4l2_init()
559 	xdev->v4l2_dev.mdev = &xdev->media_dev;  in xvip_composite_v4l2_init()
560 	ret = v4l2_device_register(xdev->dev, &xdev->v4l2_dev);  in xvip_composite_v4l2_init()
562 		dev_err(xdev->dev, "V4L2 device registration failed (%d)\n",  in xvip_composite_v4l2_init()
564 		media_device_cleanup(&xdev->media_dev);  in xvip_composite_v4l2_init()
577 	struct xvip_composite_device *xdev;  in xvip_composite_probe()  local
580 	xdev = devm_kzalloc(&pdev->dev, sizeof(*xdev), GFP_KERNEL);  in xvip_composite_probe()
581 	if (!xdev)  in xvip_composite_probe()
584 	xdev->dev = &pdev->dev;  in xvip_composite_probe()
585 	INIT_LIST_HEAD(&xdev->dmas);  in xvip_composite_probe()
587 	ret = xvip_composite_v4l2_init(xdev);  in xvip_composite_probe()
591 	ret = xvip_graph_init(xdev);  in xvip_composite_probe()
595 	platform_set_drvdata(pdev, xdev);  in xvip_composite_probe()
597 	dev_info(xdev->dev, "device registered\n");  in xvip_composite_probe()
602 	xvip_composite_v4l2_cleanup(xdev);  in xvip_composite_probe()
608 	struct xvip_composite_device *xdev = platform_get_drvdata(pdev);  in xvip_composite_remove()  local
610 	xvip_graph_cleanup(xdev);  in xvip_composite_remove()
611 	xvip_composite_v4l2_cleanup(xdev);  in xvip_composite_remove()