89 	void (*dphy_setup)(struct csi2tx_priv *csi2tx);
176 	struct csi2tx_priv *csi2tx = v4l2_subdev_to_csi2tx(subdev);  in __csi2tx_get_pad_format()  local
182 	return &csi2tx->pad_fmts[fmt->pad];  in __csi2tx_get_pad_format()
234 static void csi2tx_dphy_set_wakeup(struct csi2tx_priv *csi2tx)  in csi2tx_dphy_set_wakeup()  argument
237 	       csi2tx->base + CSI2TX_DPHY_CLK_WAKEUP_REG);  in csi2tx_dphy_set_wakeup()
244 static void csi2tx_dphy_init_finish(struct csi2tx_priv *csi2tx, u32 reg)  in csi2tx_dphy_init_finish()  argument
252 	for (i = 0; i < csi2tx->num_lanes; i++)  in csi2tx_dphy_init_finish()
253 		reg |= CSI2TX_DPHY_CFG_LANE_ENABLE(csi2tx->lanes[i] - 1);  in csi2tx_dphy_init_finish()
254 	writel(reg, csi2tx->base + CSI2TX_DPHY_CFG_REG);  in csi2tx_dphy_init_finish()
261 	       csi2tx->base + CSI2TX_DPHY_CFG_REG);  in csi2tx_dphy_init_finish()
265 static void csi2tx_dphy_setup(struct csi2tx_priv *csi2tx)  in csi2tx_dphy_setup()  argument
270 	csi2tx_dphy_set_wakeup(csi2tx);  in csi2tx_dphy_setup()
274 	for (i = 0; i < csi2tx->num_lanes; i++)  in csi2tx_dphy_setup()
275 		reg |= CSI2TX_DPHY_CFG_LANE_RESET(csi2tx->lanes[i] - 1);  in csi2tx_dphy_setup()
276 	writel(reg, csi2tx->base + CSI2TX_DPHY_CFG_REG);  in csi2tx_dphy_setup()
278 	csi2tx_dphy_init_finish(csi2tx, reg);  in csi2tx_dphy_setup()
282 static void csi2tx_v2_dphy_setup(struct csi2tx_priv *csi2tx)  in csi2tx_v2_dphy_setup()  argument
286 	csi2tx_dphy_set_wakeup(csi2tx);  in csi2tx_v2_dphy_setup()
290 	writel(reg, csi2tx->base + CSI2TX_V2_DPHY_CFG_REG);  in csi2tx_v2_dphy_setup()
292 	csi2tx_dphy_init_finish(csi2tx, reg);  in csi2tx_v2_dphy_setup()
295 static void csi2tx_reset(struct csi2tx_priv *csi2tx)  in csi2tx_reset()  argument
297 	writel(CSI2TX_CONFIG_SRST_REQ, csi2tx->base + CSI2TX_CONFIG_REG);  in csi2tx_reset()
302 static int csi2tx_start(struct csi2tx_priv *csi2tx)  in csi2tx_start()  argument
304 	struct media_entity *entity = &csi2tx->subdev.entity;  in csi2tx_start()
308 	csi2tx_reset(csi2tx);  in csi2tx_start()
310 	writel(CSI2TX_CONFIG_CFG_REQ, csi2tx->base + CSI2TX_CONFIG_REG);  in csi2tx_start()
314 	if (csi2tx->vops && csi2tx->vops->dphy_setup) {  in csi2tx_start()
315 		csi2tx->vops->dphy_setup(csi2tx);  in csi2tx_start()
338 			struct media_pad *pad = &csi2tx->pads[i];  in csi2tx_start()
350 		mfmt = &csi2tx->pad_fmts[pad_idx];  in csi2tx_start()
365 		       csi2tx->base + CSI2TX_DT_CFG_REG(stream));  in csi2tx_start()
369 		       csi2tx->base + CSI2TX_DT_FORMAT_REG(stream));  in csi2tx_start()
376 		       csi2tx->base + CSI2TX_STREAM_IF_CFG_REG(stream));  in csi2tx_start()
380 	writel(0, csi2tx->base + CSI2TX_CONFIG_REG);  in csi2tx_start()
385 static void csi2tx_stop(struct csi2tx_priv *csi2tx)  in csi2tx_stop()  argument
388 	       csi2tx->base + CSI2TX_CONFIG_REG);  in csi2tx_stop()
393 	struct csi2tx_priv *csi2tx = v4l2_subdev_to_csi2tx(subdev);  in csi2tx_s_stream()  local
396 	mutex_lock(&csi2tx->lock);  in csi2tx_s_stream()
403 		if (!csi2tx->count) {  in csi2tx_s_stream()
404 			ret = csi2tx_start(csi2tx);  in csi2tx_s_stream()
409 		csi2tx->count++;  in csi2tx_s_stream()
411 		csi2tx->count--;  in csi2tx_s_stream()
416 		if (!csi2tx->count)  in csi2tx_s_stream()
417 			csi2tx_stop(csi2tx);  in csi2tx_s_stream()
421 	mutex_unlock(&csi2tx->lock);  in csi2tx_s_stream()
434 static int csi2tx_get_resources(struct csi2tx_priv *csi2tx,  in csi2tx_get_resources()  argument
441 	csi2tx->base = devm_platform_ioremap_resource(pdev, 0);  in csi2tx_get_resources()
442 	if (IS_ERR(csi2tx->base))  in csi2tx_get_resources()
443 		return PTR_ERR(csi2tx->base);  in csi2tx_get_resources()
445 	csi2tx->p_clk = devm_clk_get(&pdev->dev, "p_clk");  in csi2tx_get_resources()
446 	if (IS_ERR(csi2tx->p_clk)) {  in csi2tx_get_resources()
448 		return PTR_ERR(csi2tx->p_clk);  in csi2tx_get_resources()
451 	csi2tx->esc_clk = devm_clk_get(&pdev->dev, "esc_clk");  in csi2tx_get_resources()
452 	if (IS_ERR(csi2tx->esc_clk)) {  in csi2tx_get_resources()
454 		return PTR_ERR(csi2tx->esc_clk);  in csi2tx_get_resources()
457 	ret = clk_prepare_enable(csi2tx->p_clk);  in csi2tx_get_resources()
463 	dev_cfg = readl(csi2tx->base + CSI2TX_DEVICE_CONFIG_REG);  in csi2tx_get_resources()
464 	clk_disable_unprepare(csi2tx->p_clk);  in csi2tx_get_resources()
466 	csi2tx->max_lanes = dev_cfg & CSI2TX_DEVICE_CONFIG_LANES_MASK;  in csi2tx_get_resources()
467 	if (csi2tx->max_lanes > CSI2TX_LANES_MAX) {  in csi2tx_get_resources()
469 			csi2tx->max_lanes);  in csi2tx_get_resources()
473 	csi2tx->max_streams = (dev_cfg & CSI2TX_DEVICE_CONFIG_STREAMS_MASK) >> 4;  in csi2tx_get_resources()
474 	if (csi2tx->max_streams > CSI2TX_STREAMS_MAX) {  in csi2tx_get_resources()
476 			csi2tx->max_streams);  in csi2tx_get_resources()
480 	csi2tx->has_internal_dphy = !!(dev_cfg & CSI2TX_DEVICE_CONFIG_HAS_DPHY);  in csi2tx_get_resources()
482 	for (i = 0; i < csi2tx->max_streams; i++) {  in csi2tx_get_resources()
486 		csi2tx->pixel_clk[i] = devm_clk_get(&pdev->dev, clk_name);  in csi2tx_get_resources()
487 		if (IS_ERR(csi2tx->pixel_clk[i])) {  in csi2tx_get_resources()
490 			return PTR_ERR(csi2tx->pixel_clk[i]);  in csi2tx_get_resources()
497 static int csi2tx_check_lanes(struct csi2tx_priv *csi2tx)  in csi2tx_check_lanes()  argument
503 	ep = of_graph_get_endpoint_by_regs(csi2tx->dev->of_node, 0, 0);  in csi2tx_check_lanes()
509 		dev_err(csi2tx->dev, "Could not parse v4l2 endpoint\n");  in csi2tx_check_lanes()
514 		dev_err(csi2tx->dev, "Unsupported media bus type: 0x%x\n",  in csi2tx_check_lanes()
520 	csi2tx->num_lanes = v4l2_ep.bus.mipi_csi2.num_data_lanes;  in csi2tx_check_lanes()
521 	if (csi2tx->num_lanes > csi2tx->max_lanes) {  in csi2tx_check_lanes()
522 		dev_err(csi2tx->dev,  in csi2tx_check_lanes()
528 	for (i = 0; i < csi2tx->num_lanes; i++) {  in csi2tx_check_lanes()
530 			dev_err(csi2tx->dev, "Invalid lane[%d] number: %u\n",  in csi2tx_check_lanes()
537 	memcpy(csi2tx->lanes, v4l2_ep.bus.mipi_csi2.data_lanes,  in csi2tx_check_lanes()
538 	       sizeof(csi2tx->lanes));  in csi2tx_check_lanes()
572 	struct csi2tx_priv *csi2tx;  in csi2tx_probe()  local
577 	csi2tx = kzalloc(sizeof(*csi2tx), GFP_KERNEL);  in csi2tx_probe()
578 	if (!csi2tx)  in csi2tx_probe()
580 	platform_set_drvdata(pdev, csi2tx);  in csi2tx_probe()
581 	mutex_init(&csi2tx->lock);  in csi2tx_probe()
582 	csi2tx->dev = &pdev->dev;  in csi2tx_probe()
584 	ret = csi2tx_get_resources(csi2tx, pdev);  in csi2tx_probe()
589 	csi2tx->vops = (struct csi2tx_vops *)of_id->data;  in csi2tx_probe()
591 	v4l2_subdev_init(&csi2tx->subdev, &csi2tx_subdev_ops);  in csi2tx_probe()
592 	csi2tx->subdev.owner = THIS_MODULE;  in csi2tx_probe()
593 	csi2tx->subdev.dev = &pdev->dev;  in csi2tx_probe()
594 	csi2tx->subdev.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;  in csi2tx_probe()
595 	snprintf(csi2tx->subdev.name, V4L2_SUBDEV_NAME_SIZE, "%s.%s",  in csi2tx_probe()
598 	ret = csi2tx_check_lanes(csi2tx);  in csi2tx_probe()
603 	csi2tx->subdev.entity.function = MEDIA_ENT_F_VID_IF_BRIDGE;  in csi2tx_probe()
604 	csi2tx->pads[CSI2TX_PAD_SOURCE].flags = MEDIA_PAD_FL_SOURCE;  in csi2tx_probe()
606 		csi2tx->pads[i].flags = MEDIA_PAD_FL_SINK;  in csi2tx_probe()
615 		csi2tx->pad_fmts[i] = fmt_default;  in csi2tx_probe()
617 	ret = media_entity_pads_init(&csi2tx->subdev.entity, CSI2TX_PAD_MAX,  in csi2tx_probe()
618 				     csi2tx->pads);  in csi2tx_probe()
622 	ret = v4l2_async_register_subdev(&csi2tx->subdev);  in csi2tx_probe()
628 		 csi2tx->num_lanes, csi2tx->max_lanes, csi2tx->max_streams,  in csi2tx_probe()
629 		 csi2tx->has_internal_dphy ? "internal" : "no");  in csi2tx_probe()
634 	kfree(csi2tx);  in csi2tx_probe()
640 	struct csi2tx_priv *csi2tx = platform_get_drvdata(pdev);  in csi2tx_remove()  local
642 	v4l2_async_unregister_subdev(&csi2tx->subdev);  in csi2tx_remove()
643 	kfree(csi2tx);  in csi2tx_remove()