From 3a6edfd376d7f53c82448774b363a33e93dfc9ac Mon Sep 17 00:00:00 2001
From: Zefa Chen <zefa.chen@rock-chips.com>
Date: Mon, 18 Jul 2022 17:47:57 +0800
Subject: [PATCH] media: spi: rk1608: support get dphy_param from link sensor

Signed-off-by: Zefa Chen <zefa.chen@rock-chips.com>
Change-Id: I60ad74821c814f67998a2d742cc67bb9bfdeed6e
---
 drivers/media/spi/rk1608_dphy.c | 25 ++++++++++++++++++++++++-
 1 file changed, 24 insertions(+), 1 deletion(-)

diff --git a/drivers/media/spi/rk1608_dphy.c b/drivers/media/spi/rk1608_dphy.c
index 9271c42221b3..24efe49a4acb 100644
--- a/drivers/media/spi/rk1608_dphy.c
+++ b/drivers/media/spi/rk1608_dphy.c
@@ -429,6 +429,7 @@ static int rk1608_g_mbus_config(struct v4l2_subdev *sd, unsigned int pad_id,
 static long rk1608_ioctl(struct v4l2_subdev *sd, unsigned int cmd, void *arg)
 {
 	struct rk1608_dphy *pdata = to_state(sd);
+	struct v4l2_subdev *link_sensor;
 	long ret = 0;
 
 	switch (cmd) {
@@ -456,6 +457,16 @@ static long rk1608_ioctl(struct v4l2_subdev *sd, unsigned int cmd, void *arg)
 				       cmd, arg);
 		mutex_unlock(&rk1608_dphy_mutex);
 		break;
+	case RKMODULE_GET_CSI_DPHY_PARAM:
+		if (!IS_ERR_OR_NULL(pdata->link_sensor_client)) {
+			link_sensor = i2c_get_clientdata(pdata->link_sensor_client);
+			if (IS_ERR_OR_NULL(link_sensor)) {
+				dev_err(pdata->dev, "can not get link sensor i2c client\n");
+				return -EINVAL;
+			}
+			ret = v4l2_subdev_call(link_sensor, core, ioctl, cmd, arg);
+		}
+		break;
 	default:
 		ret = -ENOIOCTLCMD;
 		break;
@@ -471,6 +482,7 @@ static long rk1608_compat_ioctl32(struct v4l2_subdev *sd,
 	struct preisp_hdrae_exp_s hdrae_exp;
 	struct rkmodule_inf *inf;
 	struct rkmodule_awb_cfg *cfg;
+	struct rkmodule_csi_dphy_param *dphy_param;
 	u32  stream;
 	long ret = -EFAULT;
 
@@ -501,7 +513,7 @@ static long rk1608_compat_ioctl32(struct v4l2_subdev *sd,
 			ret = -ENOMEM;
 			return ret;
 		}
-		if (copy_from_user(cfg, up, sizeof(cfg)))
+		if (copy_from_user(cfg, up, sizeof(*cfg)))
 			return -EFAULT;
 		ret = rk1608_ioctl(sd, cmd, cfg);
 		kfree(cfg);
@@ -513,6 +525,17 @@ static long rk1608_compat_ioctl32(struct v4l2_subdev *sd,
 		else
 			ret = -EFAULT;
 
+		break;
+	case RKMODULE_GET_CSI_DPHY_PARAM:
+		dphy_param = kzalloc(sizeof(*dphy_param), GFP_KERNEL);
+		if (!dphy_param) {
+			ret = -ENOMEM;
+			return ret;
+		}
+		if (copy_from_user(dphy_param, up, sizeof(*dphy_param)))
+			return -EFAULT;
+		ret = rk1608_ioctl(sd, cmd, dphy_param);
+		kfree(dphy_param);
 		break;
 	default:
 		ret = -ENOIOCTLCMD;