media: rcar-csi2: Update start procedure for H3 ES2

Latest information from hardware engineers reveals that H3 ES2 and ES3
behave differently when working with link speeds bellow 250 Mpbs.
Add a SoC match for H3 ES2.* and use the correct startup sequence.

Signed-off-by: Niklas Söderlund <niklas.soderlund+renesas@ragnatech.se>
Reviewed-by: Kieran Bingham <kieran.bingham+renesas@ideasonboard.com>
Reviewed-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com>
Signed-off-by: Hans Verkuil <hverkuil-cisco@xs4all.nl>
Signed-off-by: Mauro Carvalho Chehab <mchehab+samsung@kernel.org>

diff --git a/drivers/media/platform/rcar-vin/rcar-csi2.c b/drivers/media/platform/rcar-vin/rcar-csi2.c
index c39a0c7..73c51e9 100644 (file)
--- a/drivers/media/platform/rcar-vin/rcar-csi2.c
+++ b/drivers/media/platform/rcar-vin/rcar-csi2.c
@@ -865,7 +865,8 @@ static int rcsi2_phtw_write_mbps(struct rcar_csi2 *priv, unsigned int mbps,
        return rcsi2_phtw_write(priv, value->reg, code);
 }
 
-static int rcsi2_init_phtw_h3_v3h_m3n(struct rcar_csi2 *priv, unsigned int mbps)
+static int __rcsi2_init_phtw_h3_v3h_m3n(struct rcar_csi2 *priv,
+                                       unsigned int mbps)
 {
        static const struct phtw_value step1[] = {
                { .data = 0xcc, .code = 0xe2 },
@@ -891,7 +892,7 @@ static int rcsi2_init_phtw_h3_v3h_m3n(struct rcar_csi2 *priv, unsigned int mbps)
        if (ret)
                return ret;
 
-       if (mbps <= 250) {
+       if (mbps != 0 && mbps <= 250) {
                ret = rcsi2_phtw_write(priv, 0x39, 0x05);
                if (ret)
                        return ret;
@@ -905,6 +906,16 @@ static int rcsi2_init_phtw_h3_v3h_m3n(struct rcar_csi2 *priv, unsigned int mbps)
        return rcsi2_phtw_write_array(priv, step2);
 }
 
+static int rcsi2_init_phtw_h3_v3h_m3n(struct rcar_csi2 *priv, unsigned int mbps)
+{
+       return __rcsi2_init_phtw_h3_v3h_m3n(priv, mbps);
+}
+
+static int rcsi2_init_phtw_h3es2(struct rcar_csi2 *priv, unsigned int mbps)
+{
+       return __rcsi2_init_phtw_h3_v3h_m3n(priv, 0);
+}
+
 static int rcsi2_init_phtw_v3m_e3(struct rcar_csi2 *priv, unsigned int mbps)
 {
        return rcsi2_phtw_write_mbps(priv, mbps, phtw_mbps_v3m_e3, 0x44);
@@ -967,6 +978,14 @@ static const struct rcar_csi2_info rcar_csi2_info_r8a7795es1 = {
        .num_channels = 4,
 };
 
+static const struct rcar_csi2_info rcar_csi2_info_r8a7795es2 = {
+       .init_phtw = rcsi2_init_phtw_h3es2,
+       .hsfreqrange = hsfreqrange_h3_v3h_m3n,
+       .csi0clkfreqrange = 0x20,
+       .num_channels = 4,
+       .clear_ulps = true,
+};
+
 static const struct rcar_csi2_info rcar_csi2_info_r8a7796 = {
        .hsfreqrange = hsfreqrange_m3w_h3es1,
        .num_channels = 4,
@@ -1036,11 +1055,15 @@ static const struct of_device_id rcar_csi2_of_table[] = {
 };
 MODULE_DEVICE_TABLE(of, rcar_csi2_of_table);
 
-static const struct soc_device_attribute r8a7795es1[] = {
+static const struct soc_device_attribute r8a7795[] = {
        {
                .soc_id = "r8a7795", .revision = "ES1.*",
                .data = &rcar_csi2_info_r8a7795es1,
        },
+       {
+               .soc_id = "r8a7795", .revision = "ES2.*",
+               .data = &rcar_csi2_info_r8a7795es2,
+       },
        { /* sentinel */ },
 };
 
@@ -1058,10 +1081,10 @@ static int rcsi2_probe(struct platform_device *pdev)
        priv->info = of_device_get_match_data(&pdev->dev);
 
        /*
-        * r8a7795 ES1.x behaves differently than the ES2.0+ but doesn't
-        * have it's own compatible string.
+        * The different ES versions of r8a7795 (H3) behave differently but
+        * share the same compatible string.
         */
-       attr = soc_device_match(r8a7795es1);
+       attr = soc_device_match(r8a7795);
        if (attr)
                priv->info = attr->data;