staging: media: tegra-video: move MIPI calibration calls from VI to CSI

The CSI module does not handle all the MIPI lane calibration procedure,
leaving a small part of it to the VI module. In doing this,
tegra_channel_enable_stream() (vi.c) manipulates the private data of the
upstream subdev casting it to struct 'tegra_csi_channel', which will be
wrong after introducing a VIP (parallel video input) channel.

This prevents adding support for the VIP module.  It also breaks the
logical isolation between modules.

Since the lane calibration requirement does not exist in the parallel input
module, moving the calibration function to a per-module op is not
optimal. Instead move the calibration procedure in the CSI module, together
with the rest of the calibration procedures. After this change,
tegra_channel_enable_stream() just calls v4l2_subdev_call() to ask for a
stream start/stop to the CSI module, which in turn knows all the
CSI-specific details to implement it.

Signed-off-by: Luca Ceresoli <luca.ceresoli@bootlin.com>
Reviewed-by: Dmitry Osipenko <digetx@gmail.com>
Signed-off-by: Hans Verkuil <hverkuil-cisco@xs4all.nl>

diff --git a/drivers/staging/media/tegra-video/csi.c b/drivers/staging/media/tegra-video/csi.c
index 37b661b58cc2963e0ffca1af7bb4c1194eaf404e..052172017b3bd91e6f1dd8080dc58ecfd32ee96a 100644 (file)
--- a/drivers/staging/media/tegra-video/csi.c
+++ b/drivers/staging/media/tegra-video/csi.c
@@ -328,12 +328,42 @@ static int tegra_csi_enable_stream(struct v4l2_subdev *subdev)
        }
 
        csi_chan->pg_mode = chan->pg_mode;
+
+       /*
+        * Tegra CSI receiver can detect the first LP to HS transition.
+        * So, start the CSI stream-on prior to sensor stream-on and
+        * vice-versa for stream-off.
+        */
        ret = csi->ops->csi_start_streaming(csi_chan);
        if (ret < 0)
                goto finish_calibration;
 
+       if (csi_chan->mipi) {
+               struct v4l2_subdev *src_subdev;
+               /*
+                * TRM has incorrectly documented to wait for done status from
+                * calibration logic after CSI interface power on.
+                * As per the design, calibration results are latched and applied
+                * to the pads only when the link is in LP11 state which will happen
+                * during the sensor stream-on.
+                * CSI subdev stream-on triggers start of MIPI pads calibration.
+                * Wait for calibration to finish here after sensor subdev stream-on.
+                */
+               src_subdev = tegra_channel_get_remote_source_subdev(chan);
+               ret = v4l2_subdev_call(src_subdev, video, s_stream, true);
+
+               if (ret < 0 && ret != -ENOIOCTLCMD)
+                       goto disable_csi_stream;
+
+               err = tegra_mipi_finish_calibration(csi_chan->mipi);
+               if (err < 0)
+                       dev_warn(csi->dev, "MIPI calibration failed: %d\n", err);
+       }
+
        return 0;
 
+disable_csi_stream:
+       csi->ops->csi_stop_streaming(csi_chan);
 finish_calibration:
        if (csi_chan->mipi)
                tegra_mipi_finish_calibration(csi_chan->mipi);
@@ -352,10 +382,24 @@ rpm_put:
 
 static int tegra_csi_disable_stream(struct v4l2_subdev *subdev)
 {
+       struct tegra_vi_channel *chan = v4l2_get_subdev_hostdata(subdev);
        struct tegra_csi_channel *csi_chan = to_csi_chan(subdev);
        struct tegra_csi *csi = csi_chan->csi;
        int err;
 
+       /*
+        * Stream-off subdevices in reverse order to stream-on.
+        * Remote source subdev in TPG mode is same as CSI subdev.
+        */
+       if (csi_chan->mipi) {
+               struct v4l2_subdev *src_subdev;
+
+               src_subdev = tegra_channel_get_remote_source_subdev(chan);
+               err = v4l2_subdev_call(src_subdev, video, s_stream, false);
+               if (err < 0 && err != -ENOIOCTLCMD)
+                       dev_err_probe(csi->dev, err, "source subdev stream off failed\n");
+       }
+
        csi->ops->csi_stop_streaming(csi_chan);
 
        if (csi_chan->mipi) {

diff --git a/drivers/staging/media/tegra-video/vi.c b/drivers/staging/media/tegra-video/vi.c
index 2ef53ccb46274975f947058d3fc1d9f822c824d5..7e47de75b1704c29815f09a1c3001c572cf4f851 100644 (file)
--- a/drivers/staging/media/tegra-video/vi.c
+++ b/drivers/staging/media/tegra-video/vi.c
@@ -197,49 +197,15 @@ tegra_channel_get_remote_source_subdev(struct tegra_vi_channel *chan)
 
 static int tegra_channel_enable_stream(struct tegra_vi_channel *chan)
 {
-       struct v4l2_subdev *csi_subdev, *src_subdev;
-       struct tegra_csi_channel *csi_chan;
-       int ret, err;
+       struct v4l2_subdev *subdev;
+       int ret;
 
-       /*
-        * Tegra CSI receiver can detect the first LP to HS transition.
-        * So, start the CSI stream-on prior to sensor stream-on and
-        * vice-versa for stream-off.
-        */
-       csi_subdev = tegra_channel_get_remote_csi_subdev(chan);
-       ret = v4l2_subdev_call(csi_subdev, video, s_stream, true);
+       subdev = tegra_channel_get_remote_csi_subdev(chan);
+       ret = v4l2_subdev_call(subdev, video, s_stream, true);
        if (ret < 0 && ret != -ENOIOCTLCMD)
                return ret;
 
-       if (IS_ENABLED(CONFIG_VIDEO_TEGRA_TPG))
-               return 0;
-
-       csi_chan = v4l2_get_subdevdata(csi_subdev);
-       /*
-        * TRM has incorrectly documented to wait for done status from
-        * calibration logic after CSI interface power on.
-        * As per the design, calibration results are latched and applied
-        * to the pads only when the link is in LP11 state which will happen
-        * during the sensor stream-on.
-        * CSI subdev stream-on triggers start of MIPI pads calibration.
-        * Wait for calibration to finish here after sensor subdev stream-on.
-        */
-       src_subdev = tegra_channel_get_remote_source_subdev(chan);
-       ret = v4l2_subdev_call(src_subdev, video, s_stream, true);
-       err = tegra_mipi_finish_calibration(csi_chan->mipi);
-
-       if (ret < 0 && ret != -ENOIOCTLCMD)
-               goto err_disable_csi_stream;
-
-       if (err < 0)
-               dev_warn(csi_chan->csi->dev,
-                        "MIPI calibration failed: %d\n", err);
-
        return 0;
-
-err_disable_csi_stream:
-       v4l2_subdev_call(csi_subdev, video, s_stream, false);
-       return ret;
 }
 
 static int tegra_channel_disable_stream(struct tegra_vi_channel *chan)
@@ -247,18 +213,6 @@ static int tegra_channel_disable_stream(struct tegra_vi_channel *chan)
        struct v4l2_subdev *subdev;
        int ret;
 
-       /*
-        * Stream-off subdevices in reverse order to stream-on.
-        * Remote source subdev in TPG mode is same as CSI subdev.
-        */
-       subdev = tegra_channel_get_remote_source_subdev(chan);
-       ret = v4l2_subdev_call(subdev, video, s_stream, false);
-       if (ret < 0 && ret != -ENOIOCTLCMD)
-               return ret;
-
-       if (IS_ENABLED(CONFIG_VIDEO_TEGRA_TPG))
-               return 0;
-
        subdev = tegra_channel_get_remote_csi_subdev(chan);
        ret = v4l2_subdev_call(subdev, video, s_stream, false);
        if (ret < 0 && ret != -ENOIOCTLCMD)