Signed-off-by: Sylwester Nawrocki <[email protected]>
---
 drivers/media/video/m5mols/m5mols.h          |    1 +
 drivers/media/video/m5mols/m5mols_controls.c |   16 ++++++++++++++++
 2 files changed, 17 insertions(+)

diff --git a/drivers/media/video/m5mols/m5mols.h 
b/drivers/media/video/m5mols/m5mols.h
index b2117df..213b15b 100644
--- a/drivers/media/video/m5mols/m5mols.h
+++ b/drivers/media/video/m5mols/m5mols.h
@@ -209,6 +209,7 @@ struct m5mols_info {
        struct v4l2_ctrl *saturation;
        struct v4l2_ctrl *zoom;
        struct v4l2_ctrl *wdr;
+       struct v4l2_ctrl *stabilization;
 
        struct m5mols_version ver;
        struct m5mols_capture cap;
diff --git a/drivers/media/video/m5mols/m5mols_controls.c 
b/drivers/media/video/m5mols/m5mols_controls.c
index 08c581e..2c7beef 100644
--- a/drivers/media/video/m5mols/m5mols_controls.c
+++ b/drivers/media/video/m5mols/m5mols_controls.c
@@ -12,6 +12,7 @@
  * the Free Software Foundation; either version 2 of the License, or
  * (at your option) any later version.
  */
+#define pr_fmt(fmt) "%s:%d "fmt, __func__, __LINE__
 
 #include <linux/i2c.h>
 #include <linux/delay.h>
@@ -359,6 +360,14 @@ static int m5mols_set_wdr(struct m5mols_info *info, int 
wdr)
        return m5mols_write(&info->sd, CAPP_WDR_EN, wdr);
 }
 
+static int m5mols_set_stabilization(struct m5mols_info *info, int val)
+{
+       struct v4l2_subdev *sd = &info->sd;
+
+       v4l2_dbg(1, m5mols_debug, sd, "image stabilization: %d\n", val);
+       return 0;
+}
+
 static int m5mols_g_volatile_ctrl(struct v4l2_ctrl *ctrl)
 {
        struct v4l2_subdev *sd = to_sd(ctrl);
@@ -435,6 +444,10 @@ static int m5mols_s_ctrl(struct v4l2_ctrl *ctrl)
        case V4L2_CID_WIDE_DYNAMIC_RANGE:
                ret = m5mols_set_wdr(info, ctrl->val);
                break;
+
+       case V4L2_CID_IMAGE_STABILIZATION:
+               ret = m5mols_set_stabilization(info, ctrl->val);
+               break;
        }
 
        if (ret == 0 && info->mode != last_mode)
@@ -522,6 +535,9 @@ int m5mols_init_controls(struct v4l2_subdev *sd)
        info->wdr = v4l2_ctrl_new_std(&info->handle, &m5mols_ctrl_ops,
                        V4L2_CID_WIDE_DYNAMIC_RANGE, 0, 1, 1, 0);
 
+       info->stabilization = v4l2_ctrl_new_std(&info->handle, &m5mols_ctrl_ops,
+                       V4L2_CID_IMAGE_STABILIZATION, 0, 1, 1, 0);
+
        if (info->handle.error) {
                int ret = info->handle.error;
                v4l2_err(sd, "Failed to initialize controls: %d\n", ret);
-- 
1.7.9.2

--
To unsubscribe from this list: send the line "unsubscribe linux-media" in
the body of a message to [email protected]
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Reply via email to