cf076239bdf0b1a4a3efb2b4af04ac150bfdea43
[openwrt/staging/jow.git] /
1 From eefa9ce2af54be4a6fa33add2c3d0ddac2739622 Mon Sep 17 00:00:00 2001
2 From: Laurent Pinchart <laurent.pinchart@ideasonboard.com>
3 Date: Sun, 16 Oct 2022 09:15:18 +0300
4 Subject: [PATCH] media: i2c: imx290: Implement HBLANK and VBLANK
5 controls
6
7 Upstream commit 0c3b56c905e3.
8
9 Add support for the V4L2_CID_HBLANK and V4L2_CID_VBLANK controls to the
10 imx290 driver. Make the controls read-only to start with, to report the
11 values to userspace for timing calculation.
12
13 Signed-off-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com>
14 Signed-off-by: Sakari Ailus <sakari.ailus@linux.intel.com>
15 ---
16 drivers/media/i2c/imx290.c | 33 ++++++++++++++++++++++++++++++++-
17 1 file changed, 32 insertions(+), 1 deletion(-)
18
19 --- a/drivers/media/i2c/imx290.c
20 +++ b/drivers/media/i2c/imx290.c
21 @@ -146,6 +146,8 @@ struct imx290 {
22 struct v4l2_ctrl_handler ctrls;
23 struct v4l2_ctrl *link_freq;
24 struct v4l2_ctrl *pixel_rate;
25 + struct v4l2_ctrl *hblank;
26 + struct v4l2_ctrl *vblank;
27
28 struct mutex lock;
29 };
30 @@ -642,6 +644,20 @@ static int imx290_set_fmt(struct v4l2_su
31 if (imx290->pixel_rate)
32 __v4l2_ctrl_s_ctrl_int64(imx290->pixel_rate,
33 imx290_calc_pixel_rate(imx290));
34 +
35 + if (imx290->hblank) {
36 + unsigned int hblank = mode->hmax - mode->width;
37 +
38 + __v4l2_ctrl_modify_range(imx290->hblank, hblank, hblank,
39 + 1, hblank);
40 + }
41 +
42 + if (imx290->vblank) {
43 + unsigned int vblank = IMX290_VMAX_DEFAULT - mode->height;
44 +
45 + __v4l2_ctrl_modify_range(imx290->vblank, vblank, vblank,
46 + 1, vblank);
47 + }
48 }
49
50 *format = fmt->format;
51 @@ -880,9 +896,10 @@ static const struct media_entity_operati
52
53 static int imx290_ctrl_init(struct imx290 *imx290)
54 {
55 + unsigned int blank;
56 int ret;
57
58 - v4l2_ctrl_handler_init(&imx290->ctrls, 5);
59 + v4l2_ctrl_handler_init(&imx290->ctrls, 7);
60 imx290->ctrls.lock = &imx290->lock;
61
62 /*
63 @@ -923,6 +940,20 @@ static int imx290_ctrl_init(struct imx29
64 ARRAY_SIZE(imx290_test_pattern_menu) - 1,
65 0, 0, imx290_test_pattern_menu);
66
67 + blank = imx290->current_mode->hmax - imx290->current_mode->width;
68 + imx290->hblank = v4l2_ctrl_new_std(&imx290->ctrls, &imx290_ctrl_ops,
69 + V4L2_CID_HBLANK, blank, blank, 1,
70 + blank);
71 + if (imx290->hblank)
72 + imx290->hblank->flags |= V4L2_CTRL_FLAG_READ_ONLY;
73 +
74 + blank = IMX290_VMAX_DEFAULT - imx290->current_mode->height;
75 + imx290->vblank = v4l2_ctrl_new_std(&imx290->ctrls, &imx290_ctrl_ops,
76 + V4L2_CID_VBLANK, blank, blank, 1,
77 + blank);
78 + if (imx290->vblank)
79 + imx290->vblank->flags |= V4L2_CTRL_FLAG_READ_ONLY;
80 +
81 imx290->sd.ctrl_handler = &imx290->ctrls;
82
83 if (imx290->ctrls.error) {