media: rcar-csi2: Move PHTW write helpers

Prepare for V4M support by moving the PHTW write helpers to the generic
write helpers. This is needed as adding V4M support will involve
interact with the PHTW register from code that are logically grouped
with similar code in such a way that forward declarations of these
helpers would otherwise be needed.

The functions are moved verbatim.

Signed-off-by: Niklas Söderlund <niklas.soderlund+renesas@ragnatech.se>
Signed-off-by: Sakari Ailus <sakari.ailus@linux.intel.com>
Signed-off-by: Mauro Carvalho Chehab <mchehab+huawei@kernel.org>

diff --git a/drivers/media/platform/renesas/rcar-csi2.c b/drivers/media/platform/renesas/rcar-csi2.c
index c6fa97344516cc5db5368382b5f9596fa0f18319..0676790af472b29dc3df62982133a3ef38b9f8fe 100644 (file)
--- a/drivers/media/platform/renesas/rcar-csi2.c
+++ b/drivers/media/platform/renesas/rcar-csi2.c
@@ -662,6 +662,42 @@ static void rcsi2_write16(struct rcar_csi2 *priv, unsigned int reg, u16 data)
        iowrite16(data, priv->base + reg);
 }
 
+static int rcsi2_phtw_write(struct rcar_csi2 *priv, u8 data, u8 code)
+{
+       unsigned int timeout;
+
+       rcsi2_write(priv, priv->info->regs->phtw,
+                   PHTW_DWEN | PHTW_TESTDIN_DATA(data) |
+                   PHTW_CWEN | PHTW_TESTDIN_CODE(code));
+
+       /* Wait for DWEN and CWEN to be cleared by hardware. */
+       for (timeout = 0; timeout <= 20; timeout++) {
+               if (!(rcsi2_read(priv, priv->info->regs->phtw) & (PHTW_DWEN | PHTW_CWEN)))
+                       return 0;
+
+               usleep_range(1000, 2000);
+       }
+
+       dev_err(priv->dev, "Timeout waiting for PHTW_DWEN and/or PHTW_CWEN\n");
+
+       return -ETIMEDOUT;
+}
+
+static int rcsi2_phtw_write_array(struct rcar_csi2 *priv,
+                                 const struct phtw_value *values,
+                                 unsigned int size)
+{
+       int ret;
+
+       for (unsigned int i = 0; i < size; i++) {
+               ret = rcsi2_phtw_write(priv, values[i].data, values[i].code);
+               if (ret)
+                       return ret;
+       }
+
+       return 0;
+}
+
 static const struct rcsi2_mbps_info *
 rcsi2_mbps_to_info(struct rcar_csi2 *priv,
                   const struct rcsi2_mbps_info *infotable, unsigned int mbps)
@@ -1469,42 +1505,6 @@ static int rcsi2_parse_dt(struct rcar_csi2 *priv)
  * NOTE: Magic values are from the datasheet and lack documentation.
  */
 
-static int rcsi2_phtw_write(struct rcar_csi2 *priv, u8 data, u8 code)
-{
-       unsigned int timeout;
-
-       rcsi2_write(priv, priv->info->regs->phtw,
-                   PHTW_DWEN | PHTW_TESTDIN_DATA(data) |
-                   PHTW_CWEN | PHTW_TESTDIN_CODE(code));
-
-       /* Wait for DWEN and CWEN to be cleared by hardware. */
-       for (timeout = 0; timeout <= 20; timeout++) {
-               if (!(rcsi2_read(priv, priv->info->regs->phtw) & (PHTW_DWEN | PHTW_CWEN)))
-                       return 0;
-
-               usleep_range(1000, 2000);
-       }
-
-       dev_err(priv->dev, "Timeout waiting for PHTW_DWEN and/or PHTW_CWEN\n");
-
-       return -ETIMEDOUT;
-}
-
-static int rcsi2_phtw_write_array(struct rcar_csi2 *priv,
-                                 const struct phtw_value *values,
-                                 unsigned int size)
-{
-       int ret;
-
-       for (unsigned int i = 0; i < size; i++) {
-               ret = rcsi2_phtw_write(priv, values[i].data, values[i].code);
-               if (ret)
-                       return ret;
-       }
-
-       return 0;
-}
-
 static int rcsi2_phtw_write_mbps(struct rcar_csi2 *priv, unsigned int mbps,
                                 const struct rcsi2_mbps_info *values, u8 code)
 {