diff --git a/drivers/media/platform/tegra/camera/nvcsi/csi5_fops.c b/drivers/media/platform/tegra/camera/nvcsi/csi5_fops.c
index 896873c3..f9d2e460 100644
--- a/drivers/media/platform/tegra/camera/nvcsi/csi5_fops.c
+++ b/drivers/media/platform/tegra/camera/nvcsi/csi5_fops.c
@@ -4,7 +4,7 @@
  *
  * Tegra CSI5 device common APIs
  */
-#include <linux/log2.h>
+
 #include <media/csi.h>
 #include <media/mc_common.h>
 #include <media/csi5_registers.h>
@@ -213,7 +213,8 @@ static int csi5_stream_set_config(struct tegra_csi_channel *chan, u32 stream_id,
 	struct CAPTURE_CONTROL_MSG msg;
 	struct nvcsi_brick_config brick_config;
 	struct nvcsi_cil_config cil_config;
-	bool is_cphy = (csi_lanes == 3);
+	u32 phy_mode = read_phy_mode_from_dt(chan);
+	bool is_cphy = (phy_mode == CSI_PHY_MODE_CPHY);
 	dev_dbg(csi->dev, "%s: stream_id=%u, csi_port=%u\n",
 		__func__, stream_id, csi_port);