43 static void __setup_sensor_notification(struct fimc_md *fmd,  in __setup_sensor_notification()  argument
52 	if (!src_inf || WARN_ON(fmd == NULL))  in __setup_sensor_notification()
56 	spin_lock_irqsave(&fmd->slock, flags);  in __setup_sensor_notification()
58 	spin_unlock_irqrestore(&fmd->slock, flags);  in __setup_sensor_notification()
70 	struct fimc_md *fmd = entity_to_fimc_mdev(me);  in fimc_pipeline_prepare()  local
124 		__setup_sensor_notification(fmd, sensor, p->subdevs[IDX_FIMC]);  in fimc_pipeline_prepare()
200 	struct fimc_md *fmd = entity_to_fimc_mdev(me);  in __fimc_pipeline_open()  local
216 	if (!IS_ERR(fmd->wbclk[CLK_IDX_WB_B]) && p->subdevs[IDX_IS_ISP]) {  in __fimc_pipeline_open()
217 		ret = clk_prepare_enable(fmd->wbclk[CLK_IDX_WB_B]);  in __fimc_pipeline_open()
226 	if (!IS_ERR(fmd->wbclk[CLK_IDX_WB_B]) && p->subdevs[IDX_IS_ISP])  in __fimc_pipeline_open()
227 		clk_disable_unprepare(fmd->wbclk[CLK_IDX_WB_B]);  in __fimc_pipeline_open()
242 	struct fimc_md *fmd;  in __fimc_pipeline_close()  local
252 	fmd = entity_to_fimc_mdev(&sd->entity);  in __fimc_pipeline_close()
255 	if (!IS_ERR(fmd->wbclk[CLK_IDX_WB_B]) && p->subdevs[IDX_IS_ISP])  in __fimc_pipeline_close()
256 		clk_disable_unprepare(fmd->wbclk[CLK_IDX_WB_B]);  in __fimc_pipeline_close()
303 						struct fimc_md *fmd)  in fimc_md_pipeline_create()  argument
311 	list_add_tail(&p->list, &fmd->pipelines);  in fimc_md_pipeline_create()
317 static void fimc_md_pipelines_free(struct fimc_md *fmd)  in fimc_md_pipelines_free()  argument
319 	while (!list_empty(&fmd->pipelines)) {  in fimc_md_pipelines_free()
322 		p = list_entry(fmd->pipelines.next, typeof(*p), list);  in fimc_md_pipelines_free()
329 static int fimc_md_parse_port_node(struct fimc_md *fmd,  in fimc_md_parse_port_node()  argument
333 	struct fimc_source_info *pd = &fmd->sensor[index].pdata;  in fimc_md_parse_port_node()
351 		v4l2_info(&fmd->v4l2_dev, "Remote device at %s not found\n",  in fimc_md_parse_port_node()
369 		v4l2_err(&fmd->v4l2_dev, "Wrong port id (%u) at node %s\n",  in fimc_md_parse_port_node()
387 	if (WARN_ON(index >= ARRAY_SIZE(fmd->sensor)))  in fimc_md_parse_port_node()
390 	fmd->sensor[index].asd.match_type = V4L2_ASYNC_MATCH_OF;  in fimc_md_parse_port_node()
391 	fmd->sensor[index].asd.match.of.node = rem;  in fimc_md_parse_port_node()
392 	fmd->async_subdevs[index] = &fmd->sensor[index].asd;  in fimc_md_parse_port_node()
394 	fmd->num_sensors++;  in fimc_md_parse_port_node()
401 static int fimc_md_register_sensor_entities(struct fimc_md *fmd)  in fimc_md_register_sensor_entities()  argument
403 	struct device_node *parent = fmd->pdev->dev.of_node;  in fimc_md_register_sensor_entities()
412 	if (!fmd->pmf)  in fimc_md_register_sensor_entities()
415 	ret = pm_runtime_get_sync(fmd->pmf);  in fimc_md_register_sensor_entities()
419 	fmd->num_sensors = 0;  in fimc_md_register_sensor_entities()
432 		ret = fimc_md_parse_port_node(fmd, port, index);  in fimc_md_register_sensor_entities()
444 		ret = fimc_md_parse_port_node(fmd, node, index);  in fimc_md_register_sensor_entities()
450 	pm_runtime_put(fmd->pmf);  in fimc_md_register_sensor_entities()
468 static int register_fimc_lite_entity(struct fimc_md *fmd,  in register_fimc_lite_entity()  argument
476 		    fmd->fimc_lite[fimc_lite->index]))  in register_fimc_lite_entity()
482 	ep = fimc_md_pipeline_create(fmd);  in register_fimc_lite_entity()
488 	ret = v4l2_device_register_subdev(&fmd->v4l2_dev, sd);  in register_fimc_lite_entity()
490 		fmd->fimc_lite[fimc_lite->index] = fimc_lite;  in register_fimc_lite_entity()
492 		v4l2_err(&fmd->v4l2_dev, "Failed to register FIMC.LITE%d\n",  in register_fimc_lite_entity()
497 static int register_fimc_entity(struct fimc_md *fmd, struct fimc_dev *fimc)  in register_fimc_entity()  argument
503 	if (WARN_ON(fimc->id >= FIMC_MAX_DEVS || fmd->fimc[fimc->id]))  in register_fimc_entity()
509 	ep = fimc_md_pipeline_create(fmd);  in register_fimc_entity()
515 	ret = v4l2_device_register_subdev(&fmd->v4l2_dev, sd);  in register_fimc_entity()
517 		if (!fmd->pmf && fimc->pdev)  in register_fimc_entity()
518 			fmd->pmf = &fimc->pdev->dev;  in register_fimc_entity()
519 		fmd->fimc[fimc->id] = fimc;  in register_fimc_entity()
520 		fimc->vid_cap.user_subdev_api = fmd->user_subdev_api;  in register_fimc_entity()
522 		v4l2_err(&fmd->v4l2_dev, "Failed to register FIMC.%d (%d)\n",  in register_fimc_entity()
528 static int register_csis_entity(struct fimc_md *fmd,  in register_csis_entity()  argument
540 	if (WARN_ON(fmd->csis[id].sd))  in register_csis_entity()
544 	ret = v4l2_device_register_subdev(&fmd->v4l2_dev, sd);  in register_csis_entity()
546 		fmd->csis[id].sd = sd;  in register_csis_entity()
548 		v4l2_err(&fmd->v4l2_dev,  in register_csis_entity()
553 static int register_fimc_is_entity(struct fimc_md *fmd, struct fimc_is *is)  in register_fimc_is_entity()  argument
560 	ep = fimc_md_pipeline_create(fmd);  in register_fimc_is_entity()
566 	ret = v4l2_device_register_subdev(&fmd->v4l2_dev, sd);  in register_fimc_is_entity()
568 		v4l2_err(&fmd->v4l2_dev,  in register_fimc_is_entity()
573 	fmd->fimc_is = is;  in register_fimc_is_entity()
577 static int fimc_md_register_platform_entity(struct fimc_md *fmd,  in fimc_md_register_platform_entity()  argument
596 			ret = register_fimc_entity(fmd, drvdata);  in fimc_md_register_platform_entity()
599 			ret = register_fimc_lite_entity(fmd, drvdata);  in fimc_md_register_platform_entity()
602 			ret = register_csis_entity(fmd, pdev, drvdata);  in fimc_md_register_platform_entity()
605 			ret = register_fimc_is_entity(fmd, drvdata);  in fimc_md_register_platform_entity()
616 		dev_info(&fmd->pdev->dev, "deferring %s device registration\n",  in fimc_md_register_platform_entity()
619 		dev_err(&fmd->pdev->dev, "%s device registration failed (%d)\n",  in fimc_md_register_platform_entity()
625 static int fimc_md_register_platform_entities(struct fimc_md *fmd,  in fimc_md_register_platform_entities()  argument
651 			ret = fimc_md_register_platform_entity(fmd, pdev,  in fimc_md_register_platform_entities()
661 static void fimc_md_unregister_entities(struct fimc_md *fmd)  in fimc_md_unregister_entities()  argument
666 		struct fimc_dev *dev = fmd->fimc[i];  in fimc_md_unregister_entities()
671 		fmd->fimc[i] = NULL;  in fimc_md_unregister_entities()
674 		struct fimc_lite *dev = fmd->fimc_lite[i];  in fimc_md_unregister_entities()
679 		fmd->fimc_lite[i] = NULL;  in fimc_md_unregister_entities()
682 		if (fmd->csis[i].sd == NULL)  in fimc_md_unregister_entities()
684 		v4l2_device_unregister_subdev(fmd->csis[i].sd);  in fimc_md_unregister_entities()
685 		fmd->csis[i].sd = NULL;  in fimc_md_unregister_entities()
688 	if (fmd->fimc_is)  in fimc_md_unregister_entities()
689 		v4l2_device_unregister_subdev(&fmd->fimc_is->isp.subdev);  in fimc_md_unregister_entities()
691 	v4l2_info(&fmd->v4l2_dev, "Unregistered all entities\n");  in fimc_md_unregister_entities()
702 static int __fimc_md_create_fimc_sink_links(struct fimc_md *fmd,  in __fimc_md_create_fimc_sink_links()  argument
720 		if (!fmd->fimc[i])  in __fimc_md_create_fimc_sink_links()
726 		if (!fmd->fimc[i]->variant->has_cam_if)  in __fimc_md_create_fimc_sink_links()
731 		sink = &fmd->fimc[i]->vid_cap.subdev.entity;  in __fimc_md_create_fimc_sink_links()
743 		v4l2_info(&fmd->v4l2_dev, "created link [%s] %c> [%s]\n",  in __fimc_md_create_fimc_sink_links()
748 		if (!fmd->fimc_lite[i])  in __fimc_md_create_fimc_sink_links()
751 		sink = &fmd->fimc_lite[i]->subdev.entity;  in __fimc_md_create_fimc_sink_links()
763 		v4l2_info(&fmd->v4l2_dev, "created link [%s] -> [%s]\n",  in __fimc_md_create_fimc_sink_links()
770 static int __fimc_md_create_flite_source_links(struct fimc_md *fmd)  in __fimc_md_create_flite_source_links()  argument
776 		struct fimc_lite *fimc = fmd->fimc_lite[i];  in __fimc_md_create_flite_source_links()
789 		sink = &fmd->fimc_is->isp.subdev.entity;  in __fimc_md_create_flite_source_links()
800 static int __fimc_md_create_fimc_is_links(struct fimc_md *fmd)  in __fimc_md_create_fimc_is_links()  argument
802 	struct fimc_isp *isp = &fmd->fimc_is->isp;  in __fimc_md_create_fimc_is_links()
809 		if (fmd->fimc[i] == NULL)  in __fimc_md_create_fimc_is_links()
813 		sink = &fmd->fimc[i]->vid_cap.subdev.entity;  in __fimc_md_create_fimc_is_links()
843 static int fimc_md_create_links(struct fimc_md *fmd)  in fimc_md_create_links()  argument
852 	for (i = 0; i < fmd->num_sensors; i++) {  in fimc_md_create_links()
853 		if (fmd->sensor[i].subdev == NULL)  in fimc_md_create_links()
856 		sensor = fmd->sensor[i].subdev;  in fimc_md_create_links()
869 			csis = fmd->csis[pdata->mux_id].sd;  in fimc_md_create_links()
883 			v4l2_info(&fmd->v4l2_dev, "created link [%s] => [%s]\n",  in fimc_md_create_links()
896 			v4l2_err(&fmd->v4l2_dev, "Wrong bus_type: %x\n",  in fimc_md_create_links()
904 		ret = __fimc_md_create_fimc_sink_links(fmd, source, sensor,  in fimc_md_create_links()
909 		if (fmd->csis[i].sd == NULL)  in fimc_md_create_links()
912 		source = &fmd->csis[i].sd->entity;  in fimc_md_create_links()
917 		ret = __fimc_md_create_fimc_sink_links(fmd, source, sensor,  in fimc_md_create_links()
924 		if (!fmd->fimc[i])  in fimc_md_create_links()
927 		source = &fmd->fimc[i]->vid_cap.subdev.entity;  in fimc_md_create_links()
928 		sink = &fmd->fimc[i]->vid_cap.ve.vdev.entity;  in fimc_md_create_links()
936 	ret = __fimc_md_create_flite_source_links(fmd);  in fimc_md_create_links()
940 	if (fmd->use_isp)  in fimc_md_create_links()
941 		ret = __fimc_md_create_fimc_is_links(fmd);  in fimc_md_create_links()
949 static void fimc_md_put_clocks(struct fimc_md *fmd)  in fimc_md_put_clocks()  argument
954 		if (IS_ERR(fmd->camclk[i].clock))  in fimc_md_put_clocks()
956 		clk_put(fmd->camclk[i].clock);  in fimc_md_put_clocks()
957 		fmd->camclk[i].clock = ERR_PTR(-EINVAL);  in fimc_md_put_clocks()
962 		if (IS_ERR(fmd->wbclk[i]))  in fimc_md_put_clocks()
964 		clk_put(fmd->wbclk[i]);  in fimc_md_put_clocks()
965 		fmd->wbclk[i] = ERR_PTR(-EINVAL);  in fimc_md_put_clocks()
969 static int fimc_md_get_clocks(struct fimc_md *fmd)  in fimc_md_get_clocks()  argument
971 	struct device *dev = &fmd->pdev->dev;  in fimc_md_get_clocks()
977 		fmd->camclk[i].clock = ERR_PTR(-EINVAL);  in fimc_md_get_clocks()
988 		fmd->camclk[i].clock = clock;  in fimc_md_get_clocks()
991 		fimc_md_put_clocks(fmd);  in fimc_md_get_clocks()
993 	if (!fmd->use_isp)  in fimc_md_get_clocks()
999 	fmd->wbclk[CLK_IDX_WB_A] = ERR_PTR(-EINVAL);  in fimc_md_get_clocks()
1005 			v4l2_err(&fmd->v4l2_dev, "Failed to get clock: %s\n",  in fimc_md_get_clocks()
1010 		fmd->wbclk[i] = clock;  in fimc_md_get_clocks()
1013 		fimc_md_put_clocks(fmd);  in fimc_md_get_clocks()
1118 	struct fimc_md *fmd = platform_get_drvdata(pdev);  in fimc_md_sysfs_show()  local
1120 	if (fmd->user_subdev_api)  in fimc_md_sysfs_show()
1131 	struct fimc_md *fmd = platform_get_drvdata(pdev);  in fimc_md_sysfs_store()  local
1142 	fmd->user_subdev_api = subdev_api;  in fimc_md_sysfs_store()
1144 		if (fmd->fimc[i])  in fimc_md_sysfs_store()
1145 			fmd->fimc[i]->vid_cap.user_subdev_api = subdev_api;  in fimc_md_sysfs_store()
1159 static int fimc_md_get_pinctrl(struct fimc_md *fmd)  in fimc_md_get_pinctrl()  argument
1161 	struct device *dev = &fmd->pdev->dev;  in fimc_md_get_pinctrl()
1162 	struct fimc_pinctrl *pctl = &fmd->pinctl;  in fimc_md_get_pinctrl()
1183 	if (camclk->fmd->pmf == NULL)  in cam_clk_prepare()
1186 	ret = pm_runtime_get_sync(camclk->fmd->pmf);  in cam_clk_prepare()
1194 	if (camclk->fmd->pmf == NULL)  in cam_clk_unprepare()
1197 	pm_runtime_put_sync(camclk->fmd->pmf);  in cam_clk_unprepare()
1205 static void fimc_md_unregister_clk_provider(struct fimc_md *fmd)  in fimc_md_unregister_clk_provider()  argument
1207 	struct cam_clk_provider *cp = &fmd->clk_provider;  in fimc_md_unregister_clk_provider()
1217 static int fimc_md_register_clk_provider(struct fimc_md *fmd)  in fimc_md_register_clk_provider()  argument
1219 	struct cam_clk_provider *cp = &fmd->clk_provider;  in fimc_md_register_clk_provider()
1220 	struct device *dev = &fmd->pdev->dev;  in fimc_md_register_clk_provider()
1233 		p_name = __clk_get_name(fmd->camclk[i].clock);  in fimc_md_register_clk_provider()
1241 		camclk->fmd = fmd;  in fimc_md_register_clk_provider()
1266 	fimc_md_unregister_clk_provider(fmd);  in fimc_md_register_clk_provider()
1274 	struct fimc_md *fmd = notifier_to_fimc_md(notifier);  in subdev_notifier_bound()  local
1279 	for (i = 0; i < ARRAY_SIZE(fmd->sensor); i++)  in subdev_notifier_bound()
1280 		if (fmd->sensor[i].asd.match.of.node == subdev->dev->of_node)  in subdev_notifier_bound()
1281 			si = &fmd->sensor[i];  in subdev_notifier_bound()
1295 	v4l2_info(&fmd->v4l2_dev, "Registered sensor subdevice: %s (%d)\n",  in subdev_notifier_bound()
1296 		  subdev->name, fmd->num_sensors);  in subdev_notifier_bound()
1298 	fmd->num_sensors++;  in subdev_notifier_bound()
1305 	struct fimc_md *fmd = notifier_to_fimc_md(notifier);  in subdev_notifier_complete()  local
1308 	mutex_lock(&fmd->media_dev.graph_mutex);  in subdev_notifier_complete()
1310 	ret = fimc_md_create_links(fmd);  in subdev_notifier_complete()
1314 	ret = v4l2_device_register_subdev_nodes(&fmd->v4l2_dev);  in subdev_notifier_complete()
1316 	mutex_unlock(&fmd->media_dev.graph_mutex);  in subdev_notifier_complete()
1324 	struct fimc_md *fmd;  in fimc_md_probe()  local
1327 	fmd = devm_kzalloc(dev, sizeof(*fmd), GFP_KERNEL);  in fimc_md_probe()
1328 	if (!fmd)  in fimc_md_probe()
1331 	spin_lock_init(&fmd->slock);  in fimc_md_probe()
1332 	INIT_LIST_HEAD(&fmd->pipelines);  in fimc_md_probe()
1333 	fmd->pdev = pdev;  in fimc_md_probe()
1335 	strlcpy(fmd->media_dev.model, "SAMSUNG S5P FIMC",  in fimc_md_probe()
1336 		sizeof(fmd->media_dev.model));  in fimc_md_probe()
1337 	fmd->media_dev.link_notify = fimc_md_link_notify;  in fimc_md_probe()
1338 	fmd->media_dev.dev = dev;  in fimc_md_probe()
1340 	v4l2_dev = &fmd->v4l2_dev;  in fimc_md_probe()
1341 	v4l2_dev->mdev = &fmd->media_dev;  in fimc_md_probe()
1345 	fmd->use_isp = fimc_md_is_isp_available(dev->of_node);  in fimc_md_probe()
1346 	fmd->user_subdev_api = true;  in fimc_md_probe()
1348 	ret = v4l2_device_register(dev, &fmd->v4l2_dev);  in fimc_md_probe()
1354 	ret = media_device_register(&fmd->media_dev);  in fimc_md_probe()
1360 	ret = fimc_md_get_clocks(fmd);  in fimc_md_probe()
1364 	ret = fimc_md_get_pinctrl(fmd);  in fimc_md_probe()
1371 	platform_set_drvdata(pdev, fmd);  in fimc_md_probe()
1374 	mutex_lock(&fmd->media_dev.graph_mutex);  in fimc_md_probe()
1376 	ret = fimc_md_register_platform_entities(fmd, dev->of_node);  in fimc_md_probe()
1378 		mutex_unlock(&fmd->media_dev.graph_mutex);  in fimc_md_probe()
1382 	ret = fimc_md_register_sensor_entities(fmd);  in fimc_md_probe()
1384 		mutex_unlock(&fmd->media_dev.graph_mutex);  in fimc_md_probe()
1388 	mutex_unlock(&fmd->media_dev.graph_mutex);  in fimc_md_probe()
1398 	ret = fimc_md_register_clk_provider(fmd);  in fimc_md_probe()
1404 	if (fmd->num_sensors > 0) {  in fimc_md_probe()
1405 		fmd->subdev_notifier.subdevs = fmd->async_subdevs;  in fimc_md_probe()
1406 		fmd->subdev_notifier.num_subdevs = fmd->num_sensors;  in fimc_md_probe()
1407 		fmd->subdev_notifier.bound = subdev_notifier_bound;  in fimc_md_probe()
1408 		fmd->subdev_notifier.complete = subdev_notifier_complete;  in fimc_md_probe()
1409 		fmd->num_sensors = 0;  in fimc_md_probe()
1411 		ret = v4l2_async_notifier_register(&fmd->v4l2_dev,  in fimc_md_probe()
1412 						&fmd->subdev_notifier);  in fimc_md_probe()
1420 	fimc_md_unregister_clk_provider(fmd);  in fimc_md_probe()
1424 	fimc_md_put_clocks(fmd);  in fimc_md_probe()
1426 	fimc_md_unregister_entities(fmd);  in fimc_md_probe()
1428 	media_device_unregister(&fmd->media_dev);  in fimc_md_probe()
1430 	v4l2_device_unregister(&fmd->v4l2_dev);  in fimc_md_probe()
1436 	struct fimc_md *fmd = platform_get_drvdata(pdev);  in fimc_md_remove()  local
1438 	if (!fmd)  in fimc_md_remove()
1441 	fimc_md_unregister_clk_provider(fmd);  in fimc_md_remove()
1442 	v4l2_async_notifier_unregister(&fmd->subdev_notifier);  in fimc_md_remove()
1444 	v4l2_device_unregister(&fmd->v4l2_dev);  in fimc_md_remove()
1446 	fimc_md_unregister_entities(fmd);  in fimc_md_remove()
1447 	fimc_md_pipelines_free(fmd);  in fimc_md_remove()
1448 	media_device_unregister(&fmd->media_dev);  in fimc_md_remove()
1449 	fimc_md_put_clocks(fmd);  in fimc_md_remove()