Add support for test pattern control supported by the sensor.

Signed-off-by: Lad Prabhakar <prabhakar.mahadev-lad...@bp.renesas.com>
Reviewed-by: Biju Das <biju.das...@bp.renesas.com>
---
 drivers/media/i2c/ov772x.c | 25 ++++++++++++++++++++++++-
 include/media/i2c/ov772x.h |  1 +
 2 files changed, 25 insertions(+), 1 deletion(-)

diff --git a/drivers/media/i2c/ov772x.c b/drivers/media/i2c/ov772x.c
index 3b7dfba..bdee2a8 100644
--- a/drivers/media/i2c/ov772x.c
+++ b/drivers/media/i2c/ov772x.c
@@ -227,7 +227,7 @@
 
 /* COM3 */
 #define SWAP_MASK       (SWAP_RGB | SWAP_YUV | SWAP_ML)
-#define IMG_MASK        (VFLIP_IMG | HFLIP_IMG)
+#define IMG_MASK        (VFLIP_IMG | HFLIP_IMG | SCOLOR_TEST)
 
 #define VFLIP_IMG       0x80   /* Vertical flip image ON/OFF selection */
 #define HFLIP_IMG       0x40   /* Horizontal mirror image ON/OFF selection */
@@ -425,6 +425,7 @@ struct ov772x_priv {
        const struct ov772x_win_size     *win;
        struct v4l2_ctrl                 *vflip_ctrl;
        struct v4l2_ctrl                 *hflip_ctrl;
+       unsigned int                      test_pattern;
        /* band_filter = COM8[5] ? 256 - BDBASE : 0 */
        struct v4l2_ctrl                 *band_filter_ctrl;
        unsigned int                      fps;
@@ -540,6 +541,11 @@ static const struct ov772x_win_size ov772x_win_sizes[] = {
        },
 };
 
+static const char * const ov772x_test_pattern_menu[] = {
+       "Disabled",
+       "Vertical Color Bar Type 1",
+};
+
 /*
  * frame rate settings lists
  */
@@ -754,6 +760,13 @@ static int ov772x_s_frame_interval(struct v4l2_subdev *sd,
        return ret;
 }
 
+static int ov772x_enable_test_pattern(struct ov772x_priv *priv, u32 pattern)
+{
+       priv->test_pattern = pattern;
+       return regmap_update_bits(priv->regmap, COM3, SCOLOR_TEST,
+                                 pattern ? SCOLOR_TEST : 0x00);
+}
+
 static int ov772x_s_ctrl(struct v4l2_ctrl *ctrl)
 {
        struct ov772x_priv *priv = container_of(ctrl->handler,
@@ -801,6 +814,8 @@ static int ov772x_s_ctrl(struct v4l2_ctrl *ctrl)
                }
 
                return ret;
+       case V4L2_CID_TEST_PATTERN:
+               return ov772x_enable_test_pattern(priv, ctrl->val);
        }
 
        return -EINVAL;
@@ -1095,10 +1110,14 @@ static int ov772x_set_params(struct ov772x_priv *priv,
                val |= VFLIP_IMG;
        if (priv->info && (priv->info->flags & OV772X_FLAG_HFLIP))
                val |= HFLIP_IMG;
+       if (priv->info && (priv->info->flags & OV772X_FLAG_TEST_PATTERN))
+               val |= SCOLOR_TEST;
        if (priv->vflip_ctrl->val)
                val ^= VFLIP_IMG;
        if (priv->hflip_ctrl->val)
                val ^= HFLIP_IMG;
+       if (priv->test_pattern)
+               val ^= SCOLOR_TEST;
 
        ret = regmap_update_bits(priv->regmap, COM3, SWAP_MASK | IMG_MASK, val);
        if (ret < 0)
@@ -1399,6 +1418,10 @@ static int ov772x_probe(struct i2c_client *client)
        priv->band_filter_ctrl = v4l2_ctrl_new_std(&priv->hdl, &ov772x_ctrl_ops,
                                                   V4L2_CID_BAND_STOP_FILTER,
                                                   0, 256, 1, 0);
+       v4l2_ctrl_new_std_menu_items(&priv->hdl, &ov772x_ctrl_ops,
+                                    V4L2_CID_TEST_PATTERN,
+                                    ARRAY_SIZE(ov772x_test_pattern_menu) - 1,
+                                    0, 0, ov772x_test_pattern_menu);
        priv->subdev.ctrl_handler = &priv->hdl;
        if (priv->hdl.error) {
                ret = priv->hdl.error;
diff --git a/include/media/i2c/ov772x.h b/include/media/i2c/ov772x.h
index a1702d4..65e6f8d 100644
--- a/include/media/i2c/ov772x.h
+++ b/include/media/i2c/ov772x.h
@@ -12,6 +12,7 @@
 /* for flags */
 #define OV772X_FLAG_VFLIP      (1 << 0) /* Vertical flip image */
 #define OV772X_FLAG_HFLIP      (1 << 1) /* Horizontal flip image */
+#define OV772X_FLAG_TEST_PATTERN       (1 << 2) /* Test pattern */
 
 /*
  * for Edge ctrl
-- 
2.7.4

Reply via email to