media: i.MX6: Fix MIPI CSI-2 LP-11 check

Bitmask for the MIPI CSI-2 data PHY status doesn't seem to be correct.
Fix it.

Signed-off-by: Krzysztof Ha?asa <[email protected]>
Reviewed-by: Philipp Zabel <[email protected]>
Reviewed-by: Steve Longerbeam <[email protected]>
Signed-off-by: Mauro Carvalho Chehab <[email protected]>

diff --git a/drivers/staging/media/imx/imx6-mipi-csi2.c b/drivers/staging/media/imx/imx6-mipi-csi2.c
index 5061f3f524fd5cde2bab721114ae2d353e4e24e1..477d191c568bd4a1550f8c4d07b998aca02bf4ea 100644 (file)
--- a/drivers/staging/media/imx/imx6-mipi-csi2.c
+++ b/drivers/staging/media/imx/imx6-mipi-csi2.c
@@ -252,8 +252,8 @@ static int csi2_dphy_wait_stopstate(struct csi2_dev *csi2)
        u32 mask, reg;
        int ret;
 
-       mask = PHY_STOPSTATECLK |
-               ((csi2->bus.num_data_lanes - 1) << PHY_STOPSTATEDATA_BIT);
+       mask = PHY_STOPSTATECLK | (((1 << csi2->bus.num_data_lanes) - 1) <<
+                                  PHY_STOPSTATEDATA_BIT);
 
        ret = readl_poll_timeout(csi2->base + CSI2_PHY_STATE, reg,
                                 (reg & mask) == mask, 0, 500000);