Signed-off-by: Petko Manolov <petko.manolov@xxxxxxxxxxxx>
---
drivers/staging/media/i2c/ovm6211.c | 1156 +++++++++++++++++++++++++++
1 file changed, 1156 insertions(+)
create mode 100644 drivers/staging/media/i2c/ovm6211.c
diff --git a/drivers/staging/media/i2c/ovm6211.c b/drivers/staging/media/i2c/ovm6211.c
new file mode 100644
index 000000000000..a89c5167a892
--- /dev/null
+++ b/drivers/staging/media/i2c/ovm6211.c
@@ -0,0 +1,1156 @@
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Based on ov5640.c that lives in the same directory.
+ *
+ * Copyright (C) 2021 Petko Manolov <petko.manolov@xxxxxxxxxxxx>
+ * Copyright (C) 2021 DEKA Research & Development Corp.
+ */
+
+#define DEBUG
+
+#include <linux/clk.h>
+#include <linux/clk-provider.h>
+#include <linux/clkdev.h>
+#include <linux/ctype.h>
+#include <linux/delay.h>
+#include <linux/device.h>
+#include <linux/gpio/consumer.h>
+#include <linux/i2c.h>
+#include <linux/init.h>
+#include <linux/module.h>
+#include <linux/regmap.h>
+#include <linux/of_device.h>
+#include <linux/regulator/consumer.h>
+#include <linux/slab.h>
+#include <linux/types.h>
+#include <media/v4l2-async.h>
+#include <media/v4l2-ctrls.h>
+#include <media/v4l2-device.h>
+#include <media/v4l2-event.h>
+#include <media/v4l2-fwnode.h>
+#include <media/v4l2-subdev.h>
+
+/* Min/max system clock (xvclk) frequencies */
+#define OVM6211_XVCLK_MIN 6000000
+#define OVM6211_XVCLK_MAX 27000000
+
+/* begin of OVM6211 definitions */
+/* System Control */
+#define OVM6211_SC_MODE_SELECT 0x0100
+#define OVM6211_SC_SOFTWARE_RESET 0x0103
+#define OVM6211_SC_SCCB_ID1 0x0109
+#define OVM6211_SC_CHIP_ID_HIGH 0x300a
+#define OVM6211_SC_CHIP_ID_LOW 0x300b
+#define OVM6211_SC_REG0C 0x300c
+#define OVM6211_SC_REG10 0x3010
+#define OVM6211_SC_MIPI_PHY 0x3012
+#define OVM6211_SC_MIPI_PHY2 0x3013
+#define OVM6211_SC_MIPI_SC_CTRL0 0x3014
+#define OVM6211_SC_MIPI_SC_CTRL1 0x3015
+#define OVM6211_SC_CLKRST0 0x3016
+#define OVM6211_SC_CLKRST1 0x3017
+#define OVM6211_SC_CLKRST2 0x3018
+#define OVM6211_SC_CLKRST3 0x3019
+#define OVM6211_SC_CLKRST4 0x301a
+#define OVM6211_SC_CLKRST5 0x301b
+#define OVM6211_SC_CLKRST6 0x301c
+#define OVM6211_SC_CLOCK_SEL 0x301e
+#define OVM6211_SC_MISC_CTRL 0x301f
+#define OVM6211_SC_LOW_PWR_CTRL 0x3023
+#define OVM6211_SC_REG27 0x3027
+#define OVM6211_SC_GP_IO_IN1 0x3029
+#define OVM6211_SC_GP_IO_IN2 0x302a
+#define OVM6211_SC_SCCB_ID2 0x302b
+#define OVM6211_SC_AUTO_SLEEP_PERIOD0 0x302c
+#define OVM6211_SC_AUTO_SLEEP_PERIOD1 0x302d
+#define OVM6211_SC_AUTO_SLEEP_PERIOD2 0x302e
+#define OVM6211_SC_AUTO_SLEEP_PERIOD3 0x302f
+#define OVM6211_SC_LP_CTRL0 0x3030
+#define OVM6211_SC_REG37 0x3037
+#define OVM6211_SC_REG3B 0x303b
+/* PLL Control */
+#define OVM6211_PLL_PLL0 0x3080
+#define OVM6211_PLL_PLL1 0x3081
+#define OVM6211_PLL_PLL2 0x3082
+#define OVM6211_PLL_PLL18 0x3098
+#define OVM6211_PLL_PLL19 0x3099
+#define OVM6211_PLL_PLL1A 0x309a
+#define OVM6211_PLL_PLL1B 0x309b
+#define OVM6211_PLL_PLL1C 0x309c
+#define OVM6211_PLL_PLL1D 0x309d
+#define OVM6211_PLL_PLL1E 0x309e
+#define OVM6211_PLL_PLL1F 0x309f
+#define OVM6211_PLL_VT_PIX_CLK_DIV 0x30b0
+#define OVM6211_PLL_VT_SYS_CLK_DIV 0x30b1
+#define OVM6211_PLL_MULTIPLIER 0x30b3
+#define OVM6211_PLL_PLL1_PRE_PLL_DIV 0x30b4
+#define OVM6211_PLL_PLL1_OP_PIX_CLK_DIV 0x30b5
+#define OVM6211_PLL_PLL1_OP_SYS_CLK_DIV 0x30b6
+/* SCCB and group hold */
+#define OVM6211_SB_SRB_CTRL 0x3106
+#define OVM6211_SB_SWITCH 0x31ff
+/* AEC/AGC */
+#define OVM6211_AEC_EXPO1 0x3500
+#define OVM6211_AEC_EXPO2 0x3501
+#define OVM6211_AEC_EXPO3 0x3502
+#define OVM6211_AEC_MANUAL 0x3503
+#define OVM6211_AGC_MAN_SNR_GAIN1 0x3504
+#define OVM6211_AGC_MAN_SNR_GAIN2 0x3505
+/* timing conrol registers */
+#define OVM6211_TVTS_HI 0x380e
+#define OVM6211_TVTS_LO 0x380f
+/*Strobe frame span registers*/
+#define OVM6211_STROBE_SPAN1 0x3b8d
+#define OVM6211_STROBE_SPAN2 0x3b8e
+#define OVM6211_STROBE_SPAN3 0x3b8f
+/* format control */
+#define OVM6211_DATA_MAX_H 0x4300
+#define OVM6211_DATA_MIN_H 0x4301
+#define OVM6211_CLIP_L 0x4302
+#define OVM6211_FORMAT_CTRL3 0x4303
+#define OVM6211_FORMAT_CTRL4 0x4304
+#define OVM6211_VSYNC_WIDTH_H 0x4311
+#define OVM6211_VSYNC_WIDTH_L 0x4312
+#define OVM6211_VSYNC_CTRL 0x4313
+#define OVM6211_VSYNC_DELAY1 0x4314
+#define OVM6211_VSYNC_DELAY2 0x4315
+#define OVM6211_VSYNC_DELAY3 0x4316
+#define OVM6211_TST_PATTERN_CTRL 0x4320
+/* MIPI */
+#define OVM6211_MIPI_CTRL00 0x4800
+#define OVM6211_MIPI_CTRL01 0x4801
+#define OVM6211_MIPI_CTRL02 0x4802
+#define OVM6211_MIPI_CTRL03 0x4803
+#define OVM6211_MIPI_CTRL04 0x4804
+#define OVM6211_MIPI_CTRL05 0x4805
+#define OVM6211_MIPI_CTRL06 0x4806
+#define OVM6211_MIPI_MAX_FRAME_COUNT_H 0x4810
+#define OVM6211_MIPI_MAX_FRAME_COUNT_L 0x4811
+#define OVM6211_MIPI_SHORT_PKT_COUNTER_H 0x4812
+#define OVM6211_MIPI_SHORT_PKT_COUNTER_L 0x4813
+#define OVM6211_MIPI_CTRL14 0x4814
+#define OVM6211_MIPI_DT_SPKT 0x4815
+#define OVM6211_MIPI_REG_MAX_H 0x4835
+#define OVM6211_MIPI_REG_MAX_L 0x4836
+#define OVM6211_PCLK_PERIOD 0x4837
+#define OVM6211_WKUP_DLY 0x4838
+#define OVM6211_DIR_DLY 0x483a
+#define OVM6211_MIPI_LP_GPIO 0x483b
+#define OVM6211_MIPI_CTRL3C 0x483c
+#define OVM6211_T_TA_GO 0x483d
+#define OVM6211_T_TA_SURE 0x483e
+#define OVM6211_T_TA_GET 0x483f
+#define OVM6211_MIPI_CLIP_MAX_H 0x4846
+#define OVM6211_MIPI_CLIP_MAX_L 0x4847
+#define OVM6211_MIPI_CLIP_MIN_H 0x4848
+#define OVM6211_MIPI_CLIP_MIN_L 0x4848
+#define OVM6211_REG_INTR_MAN 0x4850
+#define OVM6211_REG_TX_WR 0x4851
+/* ISP top */
+#define OVM6211_ISP_CTRL00 0x5000
+#define OVM6211_ISP_CTRL01 0x5001
+#define OVM6211_ISP_CTRL02 0x5002
+#define OVM6211_ISP_CTRL03 0x5003
+#define OVM6211_ISP_CTRL04 0x5004
+#define OVM6211_ISP_CTRL05 0x5005
+#define OVM6211_ISP_CTRL06 0x5006
+#define OVM6211_ISP_CTRL07 0x5007
+#define OVM6211_ISP_CTRL08 0x5008
+#define OVM6211_ISP_CTRL09 0x5009
+/* window control */
+#define OVM6211_MAN_XSTART_OFF_H 0x5a00
+#define OVM6211_MAN_XSTART_OFF_L 0x5a01
+#define OVM6211_MAN_YSTART_OFF_H 0x5a02
+#define OVM6211_MAN_YSTART_OFF_L 0x5a03
+#define OVM6211_MAN_WIN_WIDTH_H 0x5a04
+#define OVM6211_MAN_WIN_WIDTH_L 0x5a05
+#define OVM6211_MAN_WIN_HEIGHT_H 0x5a06
+#define OVM6211_MAN_WIN_HEIGHT_L 0x5a07
+#define OVM6211_WIN_MAN 0x5a08
+
+#define OVM6211_LAST_REG 0x5e08
+/* end of OVM6211 definitions */
+
+enum ovm6211_mode_id {
+ OVM6211_MODE_Y8_400_200 = 0,
+ OVM6211_MODE_Y8_400_400,
+ OVM6211_NUM_MODES,
+};
+
+struct ovm6211_pixfmt {
+ u32 code;
+ u32 colorspace;
+};
+
+static const struct ovm6211_pixfmt ovm6211_formats[] = {
+ { MEDIA_BUS_FMT_Y8_1X8, V4L2_COLORSPACE_RAW, },
+ { MEDIA_BUS_FMT_Y8_1X8, V4L2_COLORSPACE_RAW, },
+};
+
+enum ovm6211_framerate_ids {
+ OVM6211_10_FPS = 0,
+ OVM6211_15_FPS,
+ OVM6211_30_FPS,
+ OVM6211_45_FPS,
+ OVM6211_60_FPS,
+ OVM6211_NUM_FRAMERATES,
+};
+
+static const int ovm6211_framerates[] = {
+ [OVM6211_10_FPS] = 10,
+ [OVM6211_15_FPS] = 15,
+ [OVM6211_30_FPS] = 30,
+ [OVM6211_45_FPS] = 45,
+ [OVM6211_60_FPS] = 60,
+};
+
+/* regulator supplies */
+static const char * const ovm6211_supply_name[] = {
+ "dovdd",
+ "avdd",
+};
+
+#define OVM6211_NUM_SUPPLIES ARRAY_SIZE(ovm6211_supply_name)
+
+static const struct regmap_config ovm6211_regmap_config = {
+ .reg_bits = 16,
+ .val_bits = 8,
+ .max_register = OVM6211_LAST_REG,
+ .cache_type = REGCACHE_NONE,
+};
+
+struct reg_value {
+ u16 reg_addr;
+ u8 val;
+ u8 mask;
+ u32 delay_ms;
+};
+
+struct ovm6211_mode_info {
+ enum ovm6211_mode_id id;
+ u32 width;
+ u32 height;
+ const struct reg_value *reg_data;
+ u32 reg_data_size;
+ u32 pixel_clock;
+};
+
+struct ovm6211_ctrls {
+ struct v4l2_ctrl_handler handler;
+ struct {
+ struct v4l2_ctrl *auto_exp;
+ struct v4l2_ctrl *exposure;
+ };
+ struct {
+ struct v4l2_ctrl *auto_gain;
+ struct v4l2_ctrl *gain;
+ };
+ struct v4l2_ctrl *brightness;
+ struct v4l2_ctrl *light_freq;
+ struct v4l2_ctrl *saturation;
+ struct v4l2_ctrl *contrast;
+ struct v4l2_ctrl *hue;
+ struct v4l2_ctrl *test_pattern;
+ struct v4l2_ctrl *link_freq;
+ struct v4l2_ctrl *pixel_clock;
+};
+
+struct ovm6211_dev {
+ struct i2c_client *i2c_client;
+ struct regmap *regmap;
+ struct v4l2_subdev sd;
+ struct media_pad pad;
+ struct v4l2_fwnode_endpoint ep; /* the parsed DT endpoint info */
+ struct clk *xclk; /* system clock to OVM6211 */
+ u32 xclk_freq;
+
+ struct regulator_bulk_data supplies[OVM6211_NUM_SUPPLIES];
+ struct gpio_desc *reset_gpio;
+ struct gpio_desc *pwdn_gpio;
+
+ struct mutex lock;
+
+ struct v4l2_mbus_framefmt fmt;
+
+ const struct ovm6211_mode_info *cur_mode;
+ enum ovm6211_framerate_ids cur_fr_id;
+ struct v4l2_fract frame_interval;
+
+ struct ovm6211_ctrls ctrls;
+
+ u32 exposure;
+ bool pending_mode_change;
+ bool pending_fi_change;
+ bool streaming;
+};
+
+static inline struct ovm6211_dev *to_ovm6211_dev(struct v4l2_subdev *sd)
+{
+ return container_of(sd, struct ovm6211_dev, sd);
+}
+
+static inline struct v4l2_subdev *ctrl_to_sd(struct v4l2_ctrl *ctrl)
+{
+ return &container_of(ctrl->handler, struct ovm6211_dev,
+ ctrls.handler)->sd;
+}
+
+static const struct reg_value ovm6211_init_y8_400_400[] = {
+ {0x0103, 0x01, 0, 0}, {0x0100, 0x00, 0, 0}, {0x3005, 0x08, 0, 0},
+ {0x3013, 0x12, 0, 0}, {0x3014, 0x04, 0, 0}, {0x3016, 0x10, 0, 0},
+ {0x3017, 0x00, 0, 0}, {0x3018, 0x00, 0, 0}, {0x301a, 0x00, 0, 0},
+ {0x301b, 0x00, 0, 0}, {0x301c, 0x00, 0, 0}, {0x3037, 0xf0, 0, 0},
+ {0x3080, 0x01, 0, 0}, {0x3081, 0x00, 0, 0}, {0x3082, 0x01, 0, 0},
+ {0x3098, 0x04, 0, 0}, {0x3099, 0x28, 0, 0}, {0x309a, 0x06, 0, 0},
+ {0x309b, 0x04, 0, 0}, {0x309c, 0x00, 0, 0}, {0x309d, 0x00, 0, 0},
+ {0x309e, 0x01, 0, 0}, {0x309f, 0x00, 0, 0}, {0x30b0, 0x08, 0, 0},
+ {0x30b1, 0x02, 0, 0}, {0x30b2, 0x00, 0, 0}, {0x30b3, 0x28, 0, 0},
+ {0x30b4, 0x02, 0, 0}, {0x30b5, 0x00, 0, 0}, {0x3106, 0xd9, 0, 0},
+ {0x3500, 0x00, 0, 0}, {0x3501, 0x1b, 0, 0}, {0x3502, 0x20, 0, 0},
+ {0x3503, 0x07, 0, 0}, {0x3509, 0x10, 0, 0}, {0x350b, 0x10, 0, 0},
+ {0x3600, 0xfc, 0, 0}, {0x3620, 0xb7, 0, 0}, {0x3621, 0x05, 0, 0},
+ {0x3626, 0x31, 0, 0}, {0x3627, 0x40, 0, 0}, {0x3632, 0xa3, 0, 0},
+ {0x3633, 0x34, 0, 0}, {0x3634, 0x40, 0, 0}, {0x3636, 0x00, 0, 0},
+ {0x3660, 0x80, 0, 0}, {0x3662, 0x03, 0, 0}, {0x3664, 0xf0, 0, 0},
+ {0x366a, 0x10, 0, 0}, {0x366b, 0x06, 0, 0}, {0x3680, 0xf4, 0, 0},
+ {0x3681, 0x50, 0, 0}, {0x3682, 0x00, 0, 0}, {0x3708, 0x20, 0, 0},
+ {0x3709, 0x40, 0, 0}, {0x370d, 0x03, 0, 0}, {0x373b, 0x02, 0, 0},
+ {0x373c, 0x08, 0, 0}, {0x3742, 0x00, 0, 0}, {0x3744, 0x16, 0, 0},
+ {0x3745, 0x08, 0, 0}, {0x3781, 0xfc, 0, 0}, {0x3788, 0x00, 0, 0},
+ {0x3800, 0x00, 0, 0}, {0x3801, 0x04, 0, 0}, {0x3802, 0x00, 0, 0},
+ {0x3803, 0x04, 0, 0}, {0x3804, 0x01, 0, 0}, {0x3805, 0x9b, 0, 0},
+ {0x3806, 0x01, 0, 0}, {0x3807, 0x9b, 0, 0}, {0x3808, 0x01, 0, 0},
+ {0x3809, 0x90, 0, 0}, {0x380a, 0x01, 0, 0}, {0x380b, 0x90, 0, 0},
+ {0x380c, 0x05, 0, 0}, {0x380d, 0xf2, 0, 0}, {0x380e, 0x03, 0, 0},
+ {0x380f, 0x6c, 0, 0}, {0x3810, 0x00, 0, 0}, {0x3811, 0x04, 0, 0},
+ {0x3812, 0x00, 0, 0}, {0x3813, 0x04, 0, 0}, {0x3814, 0x11, 0, 0},
+ {0x3815, 0x11, 0, 0}, {0x3820, 0x00, 0, 0}, {0x3821, 0x00, 0, 0},
+ {0x382b, 0xfa, 0, 0}, {0x382f, 0x04, 0, 0}, {0x3832, 0x00, 0, 0},
+ {0x3833, 0x05, 0, 0}, {0x3834, 0x00, 0, 0}, {0x3835, 0x05, 0, 0},
+ {0x3882, 0x04, 0, 0}, {0x3883, 0x00, 0, 0}, {0x38a4, 0x10, 0, 0},
+ {0x38a5, 0x00, 0, 0}, {0x38b1, 0x03, 0, 0}, {0x3b80, 0x00, 0, 0},
+ {0x3b81, 0xff, 0, 0}, {0x3b82, 0x10, 0, 0}, {0x3b83, 0x00, 0, 0},
+ {0x3b84, 0x08, 0, 0}, {0x3b85, 0x00, 0, 0}, {0x3b86, 0x01, 0, 0},
+ {0x3b87, 0x00, 0, 0}, {0x3b88, 0x00, 0, 0}, {0x3b89, 0x00, 0, 0},
+ {0x3b8a, 0x00, 0, 0}, {0x3b8b, 0x05, 0, 0}, {0x3b8c, 0x00, 0, 0},
+ {0x3b8d, 0x00, 0, 0}, {0x3b8e, 0x01, 0, 0}, {0x3b8f, 0xb2, 0, 0},
+ {0x3b94, 0x05, 0, 0}, {0x3b95, 0xf2, 0, 0}, {0x3b96, 0xc0, 0, 0},
+ {0x4004, 0x04, 0, 0}, {0x404e, 0x01, 0, 0}, {0x4801, 0x0f, 0, 0},
+ {0x4806, 0x0f, 0, 0}, {0x4837, 0x43, 0, 0}, {0x5a08, 0x00, 0, 0},
+ {0x5a01, 0x00, 0, 0}, {0x5a03, 0x00, 0, 0}, {0x5a04, 0x10, 0, 0},
+ {0x5a05, 0xa0, 0, 0}, {0x5a06, 0x0c, 0, 0}, {0x5a07, 0x78, 0, 0},
+};
+
+static const struct reg_value ovm6211_init_y8_400_200[] = {
+ {0x0103, 0x01, 0, 0}, {0x0100, 0x00, 0, 0}, {0x3005, 0x08, 0, 0},
+ {0x3013, 0x12, 0, 0}, {0x3014, 0x04, 0, 0}, {0x3016, 0x10, 0, 0},
+ {0x3017, 0x00, 0, 0}, {0x3018, 0x00, 0, 0}, {0x301a, 0x00, 0, 0},
+ {0x301b, 0x00, 0, 0}, {0x301c, 0x00, 0, 0}, {0x3037, 0xf0, 0, 0},
+ {0x3080, 0x01, 0, 0}, {0x3081, 0x00, 0, 0}, {0x3082, 0x01, 0, 0},
+ {0x3098, 0x04, 0, 0}, {0x3099, 0x28, 0, 0}, {0x309a, 0x06, 0, 0},
+ {0x309b, 0x04, 0, 0}, {0x309c, 0x00, 0, 0}, {0x309d, 0x00, 0, 0},
+ {0x309e, 0x01, 0, 0}, {0x309f, 0x00, 0, 0}, {0x30b0, 0x08, 0, 0},
+ {0x30b1, 0x02, 0, 0}, {0x30b2, 0x00, 0, 0}, {0x30b3, 0x28, 0, 0},
+ {0x30b4, 0x02, 0, 0}, {0x30b5, 0x00, 0, 0}, {0x3106, 0xd9, 0, 0},
+ {0x3500, 0x00, 0, 0}, {0x3501, 0x1b, 0, 0}, {0x3502, 0x20, 0, 0},
+ {0x3503, 0x07, 0, 0}, {0x3509, 0x10, 0, 0}, {0x350b, 0x10, 0, 0},
+ {0x3600, 0xfc, 0, 0}, {0x3620, 0xb7, 0, 0}, {0x3621, 0x05, 0, 0},
+ {0x3626, 0x31, 0, 0}, {0x3627, 0x40, 0, 0}, {0x3632, 0xa3, 0, 0},
+ {0x3633, 0x34, 0, 0}, {0x3634, 0x40, 0, 0}, {0x3636, 0x00, 0, 0},
+ {0x3660, 0x80, 0, 0}, {0x3662, 0x03, 0, 0}, {0x3664, 0xf0, 0, 0},
+ {0x366a, 0x10, 0, 0}, {0x366b, 0x06, 0, 0}, {0x3680, 0xf4, 0, 0},
+ {0x3681, 0x50, 0, 0}, {0x3682, 0x00, 0, 0}, {0x3708, 0x20, 0, 0},
+ {0x3709, 0x40, 0, 0}, {0x370d, 0x03, 0, 0}, {0x373b, 0x02, 0, 0},
+ {0x373c, 0x08, 0, 0}, {0x3742, 0x00, 0, 0}, {0x3744, 0x16, 0, 0},
+ {0x3745, 0x08, 0, 0}, {0x3781, 0xfc, 0, 0}, {0x3788, 0x00, 0, 0},
+ {0x3800, 0x00, 0, 0}, {0x3801, 0x04, 0, 0}, {0x3802, 0x00, 0, 0},
+ {0x3803, 0x04, 0, 0}, {0x3804, 0x01, 0, 0}, {0x3805, 0x9b, 0, 0},
+ {0x3806, 0x01, 0, 0}, {0x3807, 0x9b, 0, 0},
+ {0x3808, 0x01, 0, 0}, // W
+ {0x3809, 0x90, 0, 0}, // W
+ {0x380a, 0x00, 0, 0}, // H
+ {0x380b, 0xc8, 0, 0}, // H
+ {0x380c, 0x05, 0, 0}, {0x380d, 0xf2, 0, 0}, {0x380e, 0x0d, 0, 0},
+ {0x380f, 0xb0, 0, 0},
+ {0x3810, 0x00, 0, 0}, // W off
+ {0x3811, 0x04, 0, 0}, // W off: 4 + (400 - x_width)/2
+ {0x3812, 0x00, 0, 0}, // H off
+ {0x3813, 0x9a, 0, 0}, // H off: 4 + (400 - y_height)/2
+ {0x3814, 0x11, 0, 0},
+ {0x3815, 0x11, 0, 0}, {0x3820, 0x00, 0, 0}, {0x3821, 0x00, 0, 0},
+ {0x382b, 0xfa, 0, 0}, {0x382f, 0x04, 0, 0}, {0x3832, 0x00, 0, 0},
+ {0x3833, 0x05, 0, 0}, {0x3834, 0x00, 0, 0}, {0x3835, 0x05, 0, 0},
+ {0x3882, 0x04, 0, 0}, {0x3883, 0x00, 0, 0}, {0x38a4, 0x10, 0, 0},
+ {0x38a5, 0x00, 0, 0}, {0x38b1, 0x03, 0, 0}, {0x3b80, 0x00, 0, 0},
+ {0x3b81, 0xff, 0, 0}, {0x3b82, 0x10, 0, 0}, {0x3b83, 0x00, 0, 0},
+ {0x3b84, 0x08, 0, 0}, {0x3b85, 0x00, 0, 0}, {0x3b86, 0x01, 0, 0},
+ {0x3b87, 0x00, 0, 0}, {0x3b88, 0x00, 0, 0}, {0x3b89, 0x00, 0, 0},
+ {0x3b8a, 0x00, 0, 0}, {0x3b8b, 0x05, 0, 0}, {0x3b8c, 0x00, 0, 0},
+ {0x3b8d, 0x00, 0, 0}, {0x3b8e, 0x01, 0, 0}, {0x3b8f, 0xb2, 0, 0},
+ {0x3b94, 0x05, 0, 0}, {0x3b95, 0xf2, 0, 0}, {0x3b96, 0xc0, 0, 0},
+ {0x4004, 0x04, 0, 0}, {0x404e, 0x01, 0, 0}, {0x4801, 0x0f, 0, 0},
+ {0x4806, 0x0f, 0, 0}, {0x4837, 0x43, 0, 0}, {0x5a08, 0x00, 0, 0},
+ {0x5a01, 0x00, 0, 0}, {0x5a03, 0x00, 0, 0}, {0x5a04, 0x10, 0, 0},
+ {0x5a05, 0xa0, 0, 0}, {0x5a06, 0x0c, 0, 0}, {0x5a07, 0x78, 0, 0},
+};
+
+/* power-on sensor init reg table */
+static const struct ovm6211_mode_info *ovm6211_mode_init_data;
+
+static struct ovm6211_mode_info
+ovm6211_mode_data[OVM6211_NUM_MODES] = {
+ {OVM6211_MODE_Y8_400_200,
+ 400, 200,
+ ovm6211_init_y8_400_200,
+ ARRAY_SIZE(ovm6211_init_y8_400_200),
+ 400 * 400 * 60 * 2,
+ },
+ {OVM6211_MODE_Y8_400_400,
+ 400, 400,
+ ovm6211_init_y8_400_400,
+ ARRAY_SIZE(ovm6211_init_y8_400_400),
+ 400 * 400 * 60 * 2,
+ },
+};
+
+static const s64 link_freq_menu_items[] = {
+ 0,
+};
+
+#ifdef CONFIG_VIDEO_ADV_DEBUG
+static int ovm6211_get_register(struct v4l2_subdev *sd,
+ struct v4l2_dbg_register *reg)
+{
+ struct ovm6211_dev *sensor = to_ovm6211_dev(sd);
+ struct regmap *regmap = sensor->regmap;
+ unsigned int val = 0;
+ int ret;
+
+ ret = regmap_read(regmap, reg->reg, &val);
+ reg->val = val;
+ reg->size = 1;
+
+ return ret;
+}
+
+static int ovm6211_set_register(struct v4l2_subdev *sd,
+ const struct v4l2_dbg_register *reg)
+{
+ struct ovm6211_dev *sensor = to_ovm6211_dev(sd);
+ struct regmap *regmap = sensor->regmap;
+
+ return regmap_write(regmap, reg->reg, reg->val & 0xff);
+}
+#endif
+
+static int ovm6211_write_reg(struct ovm6211_dev *sensor, u16 reg, u8 val)
+{
+ struct i2c_client *client = sensor->i2c_client;
+ struct regmap *regmap = sensor->regmap;
+ int ret;
+
+ ret = regmap_write(regmap, reg, val);
+ if (ret < 0)
+ dev_err(&client->dev, "error writing reg %u\n", reg);
+
+ return ret;
+}
+
+static int ovm6211_read_reg(struct ovm6211_dev *sensor, u16 reg, u8 *val)
+{
+ struct i2c_client *client = sensor->i2c_client;
+ struct regmap *regmap = sensor->regmap;
+ unsigned int r;
+ int ret;
+
+ ret = regmap_read(regmap, reg, &r);
+ if (ret < 0)
+ dev_err(&client->dev, "error reading reg %u\n", reg);
+ *val = r & 0xff;
+
+ return ret;
+}
+
+static int ovm6211_mod_reg(struct ovm6211_dev *sensor, u16 reg, u8 mask, u8 val)
+{
+ u8 readval;
+ int ret;
+
+ ret = ovm6211_read_reg(sensor, reg, &readval);
+ if (ret)
+ return ret;
+
+ readval &= ~mask;
+ val &= mask;
+ val |= readval;
+
+ return ovm6211_write_reg(sensor, reg, val);
+}
+
+static int ovm6211_load_regs(struct ovm6211_dev *sensor,
+ const struct ovm6211_mode_info *mode)
+{
+ const struct reg_value *regs = mode->reg_data;
+ unsigned int i;
+ u32 delay_ms;
+ u16 reg_addr;
+ u8 mask, val;
+ int ret = 0;
+
+ for (i = 0; i < mode->reg_data_size; ++i, ++regs) {
+ delay_ms = regs->delay_ms;
+ reg_addr = regs->reg_addr;
+ val = regs->val;
+ mask = regs->mask;
+ if (mask)
+ ret = ovm6211_mod_reg(sensor, reg_addr, mask, val);
+ else
+ ret = ovm6211_write_reg(sensor, reg_addr, val);
+ if (ret)
+ break;
+
+ if (delay_ms) {
+ usleep_range(1000 * delay_ms, 1000 * delay_ms + 100);
+ }
+ }
+
+ return ret;
+}
+
+static void ovm6211_soft_reset(struct ovm6211_dev *sensor)
+{
+ ovm6211_write_reg(sensor, OVM6211_SC_SOFTWARE_RESET, 0x01);
+ usleep_range(5000, 9000);
+ ovm6211_write_reg(sensor, OVM6211_SC_SOFTWARE_RESET, 0x00);
+}
+
+static int ovm6211_set_exposure(struct ovm6211_dev *sensor, u32 exposure)
+{
+ u32 ce;
+ u8 v;
+
+ ovm6211_read_reg(sensor, OVM6211_TVTS_HI, &v);
+ ce = v << 8;
+ ovm6211_read_reg(sensor, OVM6211_TVTS_LO, &v);
+ ce |= v;
+ ce -= 4;
+
+ if (ce < exposure)
+ exposure = ce;
+
+ ovm6211_mod_reg(sensor, OVM6211_AEC_MANUAL, 1, 1);
+ ovm6211_write_reg(sensor, OVM6211_AEC_EXPO1, (exposure >> 12) & 0x0f);
+ ovm6211_write_reg(sensor, OVM6211_AEC_EXPO2, (exposure >> 4) & 0xff);
+ ovm6211_write_reg(sensor, OVM6211_AEC_EXPO3, (exposure << 4) & 0xf0);
+
+ /* set strobe width equal to exposure time */
+ ovm6211_write_reg(sensor, OVM6211_STROBE_SPAN1, (exposure >> 16) & 0xff);
+ ovm6211_write_reg(sensor, OVM6211_STROBE_SPAN2, (exposure >> 8) & 0xff);
+ ovm6211_write_reg(sensor, OVM6211_STROBE_SPAN3, (exposure) & 0xff);
+
+ return 0;
+}
+
+static int internal_set_stream(struct ovm6211_dev *sensor, bool on)
+{
+ u8 hi, lo;
+
+ if (sensor->pending_fi_change == false)
+ goto stream;
+
+ switch (sensor->cur_fr_id) {
+ case OVM6211_10_FPS:
+ hi = 0x14;
+ lo = 0x88;
+ break;
+ case OVM6211_15_FPS:
+ hi = 0x0d;
+ lo = 0xb0;
+ break;
+ case OVM6211_30_FPS:
+ hi = 0x06;
+ lo = 0xd8;
+ break;
+ case OVM6211_45_FPS:
+ hi=0x04;
+ lo = 0x90;
+ break;
+ case OVM6211_60_FPS:
+ hi=0x03;
+ lo = 0x6c;
+ break;
+ case OVM6211_NUM_FRAMERATES:
+ return -EINVAL;
+ }
+
+ sensor->pending_fi_change = false;
+ ovm6211_write_reg(sensor, OVM6211_TVTS_HI, hi);
+ ovm6211_write_reg(sensor, OVM6211_TVTS_LO, lo);
+stream:
+ ovm6211_write_reg(sensor, OVM6211_SC_MODE_SELECT, 0);
+ if (on) {
+ usleep_range(4000, 5000);
+ if (sensor->exposure)
+ ovm6211_set_exposure(sensor, sensor->exposure);
+ ovm6211_write_reg(sensor, OVM6211_SC_MODE_SELECT, 1);
+ sensor->streaming = true;
+ } else {
+ sensor->streaming = false;
+ }
+
+ return 0;
+}
+
+static struct ovm6211_mode_info *ovm6211_find_mode(int w, int h)
+{
+ return v4l2_find_nearest_size(ovm6211_mode_data,
+ ARRAY_SIZE(ovm6211_mode_data),
+ width, height, w, h);
+}
+
+static int ovm6211_set_mode(struct ovm6211_dev *sensor)
+{
+ const struct ovm6211_mode_info *mode = sensor->cur_mode;
+
+ ovm6211_soft_reset(sensor);
+ ovm6211_load_regs(sensor, mode);
+
+ return 0;
+}
+
+/* --------------- Subdev Operations --------------- */
+
+static int ovm6211_get_fmt(struct v4l2_subdev *sd,
+ struct v4l2_subdev_state *state,
+ struct v4l2_subdev_format *format)
+{
+ struct ovm6211_dev *sensor = to_ovm6211_dev(sd);
+ struct v4l2_mbus_framefmt *fmt;
+
+ if (format->pad != 0)
+ return -EINVAL;
+
+ mutex_lock(&sensor->lock);
+
+ if (format->which == V4L2_SUBDEV_FORMAT_TRY) {
+ fmt = v4l2_subdev_get_try_format(&sensor->sd, state, format->pad);
+ format->format = *fmt;
+ } else {
+ /* these are hardcoded as we don't support anything else */
+ format->format.colorspace = V4L2_COLORSPACE_RAW;
+ format->format.field = V4L2_FIELD_NONE;
+ format->format.code = MEDIA_BUS_FMT_Y8_1X8;
+ format->format.width = sensor->cur_mode->width;
+ format->format.height = sensor->cur_mode->height;
+ }
+
+ mutex_unlock(&sensor->lock);
+
+ return 0;
+}
+
+u32 ovm6211_set_pix_clk(struct ovm6211_dev *sensor, const struct ovm6211_mode_info *nm)
+{
+ u32 s, fmt, fps, ret;
+
+ /* x * y * [1|2] * y8/y10 * fps */
+ s = nm->width * nm->height;
+ fmt = 1;
+ fps = ovm6211_framerates[sensor->cur_fr_id];
+ ret = s * fmt * fps * 2;
+
+ return ret;
+}
+
+static int ovm6211_set_fmt(struct v4l2_subdev *sd,
+ struct v4l2_subdev_state *state,
+ struct v4l2_subdev_format *format)
+{
+ struct ovm6211_dev *sensor = to_ovm6211_dev(sd);
+ struct v4l2_mbus_framefmt *fmt = &format->format;
+ struct ovm6211_mode_info *mode;
+
+ if (format->pad != 0)
+ return -EINVAL;
+
+ if (sensor->streaming)
+ return -EBUSY;
+
+ mutex_lock(&sensor->lock);
+
+ /* these are hardcoded as we don't support anything else */
+ format->format.colorspace = V4L2_COLORSPACE_RAW;
+ format->format.field = V4L2_FIELD_NONE;
+ format->format.code = MEDIA_BUS_FMT_Y8_1X8;
+ mode = ovm6211_find_mode(format->format.width, format->format.height);
+ format->format.width = mode->width;
+ format->format.height = mode->height;
+
+ if (format->which == V4L2_SUBDEV_FORMAT_TRY) {
+ fmt = v4l2_subdev_get_try_format(&sensor->sd, state, format->pad);
+ *fmt = format->format;
+ goto out;
+ }
+ /* V4L2_SUBDEV_FORMAT_TRY_ACTIVE */
+ sensor->cur_mode = mode;
+out:
+ mutex_unlock(&sensor->lock);
+
+ return 0;
+}
+
+/*
+ * Sensor Controls.
+ */
+
+static int ovm6211_set_ctrl_exposure(struct ovm6211_dev *sensor, enum
+ v4l2_exposure_auto_type auto_exposure)
+{
+ struct ovm6211_ctrls *ctrls = &sensor->ctrls;
+
+ if (auto_exposure == V4L2_EXPOSURE_AUTO) {
+ sensor->exposure = 0;
+ } else {
+ sensor->exposure = ctrls->exposure->val;
+ ovm6211_set_exposure(sensor, sensor->exposure);
+ }
+
+ return 0;
+}
+
+static int ovm6211_set_ctrl_gain(struct ovm6211_dev *sensor, bool auto_gain)
+{
+ return 0;
+}
+
+static int ovm6211_s_ctrl(struct v4l2_ctrl *ctrl)
+{
+ struct v4l2_subdev *sd = ctrl_to_sd(ctrl);
+ struct ovm6211_dev *sensor = to_ovm6211_dev(sd);
+ int ret;
+
+ /* v4l2_ctrl_lock() locks our own mutex */
+
+ /*
+ * If the device is not powered up by the host driver do
+ * not apply any controls to H/W at this time. Instead
+ * the controls will be restored right after power-up.
+ */
+ switch (ctrl->id) {
+ case V4L2_CID_GAIN:
+ ret = ovm6211_set_ctrl_gain(sensor, ctrl->val);
+ break;
+ case V4L2_CID_EXPOSURE_AUTO:
+ ret = ovm6211_set_ctrl_exposure(sensor, ctrl->val);
+ break;
+#if 0
+ case V4L2_CID_AUTO_WHITE_BALANCE:
+ ret = ovm6211_set_ctrl_white_balance(sensor, ctrl->val);
+ break;
+ case V4L2_CID_HUE:
+ ret = ovm6211_set_ctrl_hue(sensor, ctrl->val);
+ break;
+ case V4L2_CID_CONTRAST:
+ ret = ovm6211_set_ctrl_contrast(sensor, ctrl->val);
+ break;
+ case V4L2_CID_SATURATION:
+ ret = ovm6211_set_ctrl_saturation(sensor, ctrl->val);
+ break;
+ case V4L2_CID_TEST_PATTERN:
+ ret = ovm6211_set_ctrl_test_pattern(sensor, ctrl->val);
+ break;
+ case V4L2_CID_POWER_LINE_FREQUENCY:
+ ret = ovm6211_set_ctrl_light_freq(sensor, ctrl->val);
+ break;
+#endif
+ case V4L2_CID_LINK_FREQ:
+ return 0;
+ case V4L2_CID_PIXEL_RATE:
+ return 0;
+ default:
+ ret = -EINVAL;
+ break;
+ }
+
+ return ret;
+}
+
+static const struct v4l2_ctrl_ops ovm6211_ctrl_ops = {
+ .s_ctrl = ovm6211_s_ctrl,
+};
+
+static int ovm6211_init_controls(struct ovm6211_dev *sensor)
+{
+ const struct v4l2_ctrl_ops *ops = &ovm6211_ctrl_ops;
+ struct ovm6211_ctrls *ctrls = &sensor->ctrls;
+ struct v4l2_ctrl_handler *hdl = &ctrls->handler;
+ int ret;
+
+ v4l2_ctrl_handler_init(hdl, 32);
+
+ /* we can use our own mutex for the ctrl lock */
+ hdl->lock = &sensor->lock;
+
+ ctrls->auto_exp = v4l2_ctrl_new_std_menu(hdl, ops, V4L2_CID_EXPOSURE_AUTO,
+ V4L2_EXPOSURE_MANUAL, 0,
+ V4L2_EXPOSURE_AUTO);
+ ctrls->exposure = v4l2_ctrl_new_std(hdl, ops, V4L2_CID_EXPOSURE,
+ 0, 65535, 1, 0);
+ ctrls->gain = v4l2_ctrl_new_std(hdl, ops, V4L2_CID_GAIN,
+ 0, 1023, 1, 0);
+
+ v4l2_ctrl_auto_cluster(3, &ctrls->auto_exp, 0, false);
+
+ ctrls->saturation = v4l2_ctrl_new_std(hdl, ops, V4L2_CID_SATURATION,
+ 0, 255, 1, 64);
+ ctrls->hue = v4l2_ctrl_new_std(hdl, ops, V4L2_CID_HUE,
+ 0, 359, 1, 0);
+ ctrls->contrast = v4l2_ctrl_new_std(hdl, ops, V4L2_CID_CONTRAST,
+ 0, 255, 1, 0);
+ ctrls->light_freq =
+ v4l2_ctrl_new_std_menu(hdl, ops,
+ V4L2_CID_POWER_LINE_FREQUENCY,
+ V4L2_CID_POWER_LINE_FREQUENCY_AUTO, 0,
+ V4L2_CID_POWER_LINE_FREQUENCY_50HZ);
+ ctrls->link_freq = v4l2_ctrl_new_int_menu(hdl, ops, V4L2_CID_LINK_FREQ,
+ 0, 0, link_freq_menu_items);
+ ctrls->pixel_clock = v4l2_ctrl_new_std(hdl, ops, V4L2_CID_PIXEL_RATE,
+ 1, INT_MAX, 1, 38400000);
+
+ if (hdl->error) {
+ ret = hdl->error;
+ goto free_ctrls;
+ }
+
+ ctrls->gain->flags |= V4L2_CTRL_FLAG_VOLATILE;
+ ctrls->exposure->flags |= V4L2_CTRL_FLAG_VOLATILE;
+
+ sensor->sd.ctrl_handler = hdl;
+ return 0;
+
+free_ctrls:
+ v4l2_ctrl_handler_free(hdl);
+ return ret;
+}
+
+static int ovm6211_g_frame_interval(struct v4l2_subdev *sd,
+ struct v4l2_subdev_frame_interval *fi)
+{
+ struct ovm6211_dev *sensor = to_ovm6211_dev(sd);
+
+ mutex_lock(&sensor->lock);
+ fi->interval = sensor->frame_interval;
+ mutex_unlock(&sensor->lock);
+
+ return 0;
+}
+
+static int internal_set_frame_interval(struct ovm6211_dev *sensor, struct
+ v4l2_subdev_frame_interval *fi)
+{
+ u32 fr_rate;
+ int i, max, ret = -EINVAL;
+
+ if (fi->interval.numerator == 0)
+ goto out;
+
+ fr_rate = fi->interval.denominator / fi->interval.numerator;
+
+ max = ARRAY_SIZE(ovm6211_framerates);
+ for (i = 0; i < max; i++) {
+ if (ovm6211_framerates[i] == fr_rate)
+ break;
+ }
+
+ if (i == max)
+ goto out;
+
+ sensor->cur_fr_id = i;
+ sensor->frame_interval = fi->interval;
+ ret = 0;
+out:
+ return ret;
+}
+
+static int ovm6211_s_frame_interval(struct v4l2_subdev *sd,
+ struct v4l2_subdev_frame_interval *fi)
+{
+ struct ovm6211_dev *sensor = to_ovm6211_dev(sd);
+ int ret;
+
+ mutex_lock(&sensor->lock);
+ ret = internal_set_frame_interval(sensor, fi);
+ sensor->pending_fi_change = true;
+ mutex_unlock(&sensor->lock);
+
+ return ret;
+}
+
+static int ovm6211_enum_mbus_code(struct v4l2_subdev *sd,
+ struct v4l2_subdev_state *state,
+ struct v4l2_subdev_mbus_code_enum *code)
+{
+ if (code->pad != 0)
+ return -EINVAL;
+ if (code->index >= ARRAY_SIZE(ovm6211_formats))
+ return -EINVAL;
+
+ code->code = ovm6211_formats[code->index].code;
+
+ return 0;
+}
+
+static int ovm6211_s_stream(struct v4l2_subdev *sd, int enable)
+{
+ struct ovm6211_dev *sensor = to_ovm6211_dev(sd);
+ int ret = 0;
+
+ mutex_lock(&sensor->lock);
+
+ if (enable)
+ ret = ovm6211_set_mode(sensor);
+ internal_set_stream(sensor, enable);
+
+ mutex_unlock(&sensor->lock);
+
+ return ret;
+}
+
+static int ovm6211_set_power(struct v4l2_subdev *sd, int on)
+{
+ return 0;
+}
+
+static const struct v4l2_subdev_core_ops ovm6211_core_ops = {
+#ifdef CONFIG_VIDEO_ADV_DEBUG
+ .g_register = ovm6211_get_register,
+ .s_register = ovm6211_set_register,
+#endif
+ .s_power = ovm6211_set_power,
+};
+
+static const struct v4l2_subdev_video_ops ovm6211_video_ops = {
+ .g_frame_interval = ovm6211_g_frame_interval,
+ .s_frame_interval = ovm6211_s_frame_interval,
+ .s_stream = ovm6211_s_stream,
+};
+
+static const struct v4l2_subdev_pad_ops ovm6211_pad_ops = {
+ .enum_mbus_code = ovm6211_enum_mbus_code,
+ .get_fmt = ovm6211_get_fmt,
+ .set_fmt = ovm6211_set_fmt,
+};
+
+static const struct v4l2_subdev_ops ovm6211_subdev_ops = {
+ .core = &ovm6211_core_ops,
+ .video = &ovm6211_video_ops,
+ .pad = &ovm6211_pad_ops,
+};
+
+static int ovm6211_get_regulators(struct ovm6211_dev *sensor)
+{
+ int i;
+
+ for (i = 0; i < OVM6211_NUM_SUPPLIES; i++)
+ sensor->supplies[i].supply = ovm6211_supply_name[i];
+
+ return devm_regulator_bulk_get(&sensor->i2c_client->dev,
+ OVM6211_NUM_SUPPLIES,
+ sensor->supplies);
+}
+
+static int ovm6211_check_chip_id(struct ovm6211_dev *sensor)
+{
+ struct i2c_client *client = sensor->i2c_client;
+ struct regmap *regmap = sensor->regmap;
+ unsigned int cid;
+ int ret = 0;
+
+ ret = regmap_read(regmap, OVM6211_SC_CHIP_ID_HIGH, &cid);
+ if (ret || cid != 0x67) {
+ ret = ENXIO;
+ goto err;
+ }
+
+ ret = regmap_read(regmap, OVM6211_SC_CHIP_ID_LOW, &cid);
+ if (ret || cid != 0x10) {
+ ret = -ENXIO;
+ goto err;
+ }
+
+ ret = regmap_read(regmap, OVM6211_SC_REG0C, &cid);
+ if (ret)
+ goto err;
+
+ dev_info(&client->dev,"found OVM6211, sub revision: 0x%02X\n", cid);
+ return 0;
+err:
+ dev_err(&client->dev, "failed to detect OVM6211\n");
+ return ret;
+}
+
+static int ovm6211_probe(struct i2c_client *client)
+{
+ struct device *dev = &client->dev;
+ struct fwnode_handle *endpoint;
+ struct ovm6211_dev *sensor;
+ struct v4l2_mbus_framefmt *fmt;
+ int ret;
+
+ sensor = devm_kzalloc(dev, sizeof(*sensor), GFP_KERNEL);
+ if (!sensor)
+ return -ENOMEM;
+
+ sensor->i2c_client = client;
+
+ /*
+ * default init sequence initialize sensor to
+ * YUV422 UYVY VGA@30fps
+ */
+ fmt = &sensor->fmt;
+ fmt->code = MEDIA_BUS_FMT_Y8_1X8;
+ fmt->colorspace = V4L2_COLORSPACE_RAW;
+ fmt->field = V4L2_FIELD_NONE;
+ fmt->quantization = V4L2_QUANTIZATION_FULL_RANGE;
+ fmt->xfer_func = V4L2_MAP_XFER_FUNC_DEFAULT(fmt->colorspace);
+ fmt->width = 400;
+ fmt->height = 200;
+
+ sensor->frame_interval.numerator = 1;
+ sensor->frame_interval.denominator = ovm6211_framerates[OVM6211_45_FPS];
+ sensor->cur_fr_id = OVM6211_45_FPS;
+ ovm6211_mode_init_data = &ovm6211_mode_data[OVM6211_MODE_Y8_400_200];
+ sensor->cur_mode = ovm6211_mode_init_data;
+
+ sensor->ep.bus_type = V4L2_MBUS_CSI2_DPHY;
+ endpoint = fwnode_graph_get_next_endpoint(dev_fwnode(&client->dev), NULL);
+ if (!endpoint) {
+ dev_err(dev, "endpoint node not found\n");
+ return -EINVAL;
+ }
+
+ ret = v4l2_fwnode_endpoint_parse(endpoint, &sensor->ep);
+ fwnode_handle_put(endpoint);
+ if (ret) {
+ dev_err(dev, "Could not parse endpoint\n");
+ return ret;
+ }
+
+ /* get system clock (xclk) */
+ sensor->xclk = devm_clk_get(dev, "xvclk");
+ if (IS_ERR(sensor->xclk)) {
+ dev_err(dev, "failed to get xvclk\n");
+ return PTR_ERR(sensor->xclk);
+ }
+
+ sensor->xclk_freq = clk_get_rate(sensor->xclk);
+ if (sensor->xclk_freq < OVM6211_XVCLK_MIN ||
+ sensor->xclk_freq > OVM6211_XVCLK_MAX) {
+ dev_err(dev, "xvclk frequency out of range: %d Hz\n",
+ sensor->xclk_freq);
+ return -EINVAL;
+ }
+
+ /* request optional power down pin */
+ sensor->pwdn_gpio = devm_gpiod_get_optional(dev, "powerdown",
+ GPIOD_OUT_HIGH);
+ if (IS_ERR(sensor->pwdn_gpio))
+ return PTR_ERR(sensor->pwdn_gpio);
+
+ /* request optional reset pin */
+ sensor->reset_gpio = devm_gpiod_get_optional(dev, "reset",
+ GPIOD_OUT_HIGH);
+ if (IS_ERR(sensor->reset_gpio))
+ return PTR_ERR(sensor->reset_gpio);
+
+ sensor->regmap = devm_regmap_init_i2c(client, &ovm6211_regmap_config);
+ if (IS_ERR(sensor->regmap)) {
+ dev_err(dev, "regmap init failed\n");
+ return PTR_ERR(sensor->regmap);
+ }
+
+ v4l2_i2c_subdev_init(&sensor->sd, client, &ovm6211_subdev_ops);
+
+ sensor->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE |
+ V4L2_SUBDEV_FL_HAS_EVENTS;
+ sensor->pad.flags = MEDIA_PAD_FL_SOURCE;
+ sensor->sd.entity.function = MEDIA_ENT_F_CAM_SENSOR;
+ ret = media_entity_pads_init(&sensor->sd.entity, 1, &sensor->pad);
+ if (ret)
+ return ret;
+
+ ret = ovm6211_get_regulators(sensor);
+ if (ret)
+ return ret;
+
+ ret = ovm6211_set_power(&sensor->sd, 1);
+ if (ret)
+ return ret;
+
+ mutex_init(&sensor->lock);
+
+ ret = ovm6211_check_chip_id(sensor);
+ if (ret)
+ goto entity_cleanup;
+
+ ret = ovm6211_init_controls(sensor);
+ if (ret)
+ goto entity_cleanup;
+
+ ret = v4l2_async_register_subdev_sensor(&sensor->sd);
+ if (ret)
+ goto free_ctrls;
+
+ ovm6211_load_regs(sensor, ovm6211_mode_init_data);
+
+ dev_dbg(dev, "%s() completed\n", __func__);
+ return 0;
+
+free_ctrls:
+ v4l2_ctrl_handler_free(&sensor->ctrls.handler);
+entity_cleanup:
+ media_entity_cleanup(&sensor->sd.entity);
+ mutex_destroy(&sensor->lock);
+ return ret;
+}
+
+static int ovm6211_remove(struct i2c_client *client)
+{
+ struct v4l2_subdev *sd = i2c_get_clientdata(client);
+ struct ovm6211_dev *sensor = to_ovm6211_dev(sd);
+
+ v4l2_async_unregister_subdev(&sensor->sd);
+ media_entity_cleanup(&sensor->sd.entity);
+ v4l2_ctrl_handler_free(&sensor->ctrls.handler);
+ mutex_destroy(&sensor->lock);
+
+ return 0;
+}
+
+static const struct i2c_device_id ovm6211_id[] = {
+ { "ovm6211", 0 },
+ {},
+};
+MODULE_DEVICE_TABLE(i2c, ovm6211_id);
+
+static const struct of_device_id ovm6211_dt_ids[] = {
+ { .compatible = "ovti,ovm6211" },
+ { /* sentinel */ }
+};
+MODULE_DEVICE_TABLE(of, ovm6211_dt_ids);
+
+static struct i2c_driver ovm6211_i2c_driver = {
+ .driver = {
+ .name = "ovm6211",
+ .of_match_table = ovm6211_dt_ids,
+ },
+ .id_table = ovm6211_id,
+ .probe_new = ovm6211_probe,
+ .remove = ovm6211_remove,
+};
+
+module_i2c_driver(ovm6211_i2c_driver);
+
+MODULE_AUTHOR("Petko Manolov <petko.manolov@xxxxxxxxxxxx>");
+MODULE_DESCRIPTION("OVM6211 MIPI Camera Subdev Driver");
+MODULE_LICENSE("GPL");
--
2.30.2
