* [PATCH v5 0/2] media: i2c: OV5648 image sensor support
@ 2020-12-11 15:40 Paul Kocialkowski
2020-12-11 15:40 ` [PATCH v5 1/2] dt-bindings: media: i2c: Add OV5648 bindings documentation Paul Kocialkowski
2020-12-11 15:40 ` [PATCH v5 2/2] media: i2c: Add support for the OV5648 image sensor Paul Kocialkowski
0 siblings, 2 replies; 5+ messages in thread
From: Paul Kocialkowski @ 2020-12-11 15:40 UTC (permalink / raw)
To: linux-media, devicetree, linux-kernel, linux-arm-kernel
Cc: Mauro Carvalho Chehab, Rob Herring, Maxime Ripard,
Paul Kocialkowski, Hans Verkuil, Sakari Ailus, Thomas Petazzoni
This series adds support for the OV5648 image sensor,
as a V4L2 subdev driver.
Changes since v4:
- Squashed tailing function calls in return;
- Added Kconfig depend on PM since it's not optional;
- Reordered runtime PM in init;
- Reworked runtime PM order and added ctrls handler free in exit.
Changes since v3:
- Removed mipi_clk_rate variable that skipped through.
Changes since v2:
- Added link-frequencies endpoint property support;
- Used NULL ctrl ops for pixel rate and link freq;
- Extra cosmetic changes.
Changes since v1:
- Used runtime pm;
- Used assigned-clock-rate;
- Removed clock name;
- Returned closest size in set_fmt;
- Removed unneeded references to v4l2 controls;
- Removed i2c device table;
- Dual-licensed bindings;
- Used SPDX tags.
Paul Kocialkowski (2):
dt-bindings: media: i2c: Add OV5648 bindings documentation
media: i2c: Add support for the OV5648 image sensor
.../bindings/media/i2c/ovti,ov5648.yaml | 115 +
drivers/media/i2c/Kconfig | 13 +
drivers/media/i2c/Makefile | 1 +
drivers/media/i2c/ov5648.c | 2638 +++++++++++++++++
4 files changed, 2767 insertions(+)
create mode 100644 Documentation/devicetree/bindings/media/i2c/ovti,ov5648.yaml
create mode 100644 drivers/media/i2c/ov5648.c
--
2.29.2
^ permalink raw reply [flat|nested] 5+ messages in thread
* [PATCH v5 1/2] dt-bindings: media: i2c: Add OV5648 bindings documentation
2020-12-11 15:40 [PATCH v5 0/2] media: i2c: OV5648 image sensor support Paul Kocialkowski
@ 2020-12-11 15:40 ` Paul Kocialkowski
2020-12-11 15:40 ` [PATCH v5 2/2] media: i2c: Add support for the OV5648 image sensor Paul Kocialkowski
1 sibling, 0 replies; 5+ messages in thread
From: Paul Kocialkowski @ 2020-12-11 15:40 UTC (permalink / raw)
To: linux-media, devicetree, linux-kernel, linux-arm-kernel
Cc: Mauro Carvalho Chehab, Rob Herring, Maxime Ripard,
Paul Kocialkowski, Hans Verkuil, Sakari Ailus, Thomas Petazzoni,
Rob Herring
This introduces YAML bindings documentation for the OV5648
image sensor.
Signed-off-by: Paul Kocialkowski <paul.kocialkowski@bootlin.com>
Reviewed-by: Rob Herring <robh@kernel.org>
---
.../bindings/media/i2c/ovti,ov5648.yaml | 115 ++++++++++++++++++
1 file changed, 115 insertions(+)
create mode 100644 Documentation/devicetree/bindings/media/i2c/ovti,ov5648.yaml
diff --git a/Documentation/devicetree/bindings/media/i2c/ovti,ov5648.yaml b/Documentation/devicetree/bindings/media/i2c/ovti,ov5648.yaml
new file mode 100644
index 000000000000..f8783f77cc54
--- /dev/null
+++ b/Documentation/devicetree/bindings/media/i2c/ovti,ov5648.yaml
@@ -0,0 +1,115 @@
+# SPDX-License-Identifier: (GPL-2.0 OR BSD-2-Clause)
+%YAML 1.2
+---
+$id: http://devicetree.org/schemas/media/i2c/ovti,ov5648.yaml#
+$schema: http://devicetree.org/meta-schemas/core.yaml#
+
+title: OmniVision OV5648 Image Sensor Device Tree Bindings
+
+maintainers:
+ - Paul Kocialkowski <paul.kocialkowski@bootlin.com>
+
+properties:
+ compatible:
+ const: ovti,ov5648
+
+ reg:
+ maxItems: 1
+
+ clocks:
+ items:
+ - description: XVCLK Clock
+
+ assigned-clocks:
+ maxItems: 1
+
+ assigned-clock-rates:
+ maxItems: 1
+
+ dvdd-supply:
+ description: Digital Domain Power Supply
+
+ avdd-supply:
+ description: Analog Domain Power Supply (internal AVDD is used if missing)
+
+ dovdd-supply:
+ description: I/O Domain Power Supply
+
+ powerdown-gpios:
+ maxItems: 1
+ description: Power Down Pin GPIO Control (active low)
+
+ reset-gpios:
+ maxItems: 1
+ description: Reset Pin GPIO Control (active low)
+
+ port:
+ type: object
+ description: MIPI CSI-2 transmitter port
+
+ properties:
+ endpoint:
+ type: object
+
+ properties:
+ remote-endpoint: true
+
+ link-frequencies:
+ $ref: /schemas/types.yaml#/definitions/uint64-array
+ description: Allowed MIPI CSI-2 link frequencies
+
+ data-lanes:
+ minItems: 1
+ maxItems: 2
+
+ required:
+ - data-lanes
+ - link-frequencies
+ - remote-endpoint
+
+ required:
+ - endpoint
+
+required:
+ - compatible
+ - reg
+ - clocks
+ - assigned-clocks
+ - assigned-clock-rates
+ - dvdd-supply
+ - dovdd-supply
+ - port
+
+additionalProperties: false
+
+examples:
+ - |
+ #include <dt-bindings/clock/sun8i-v3s-ccu.h>
+ #include <dt-bindings/gpio/gpio.h>
+
+ i2c0 {
+ #address-cells = <1>;
+ #size-cells = <0>;
+
+ ov5648: camera@36 {
+ compatible = "ovti,ov5648";
+ reg = <0x36>;
+
+ dvdd-supply = <&ov5648_dvdd>;
+ avdd-supply = <&ov5648_avdd>;
+ dovdd-supply = <&ov5648_dovdd>;
+ clocks = <&ov5648_xvclk 0>;
+ assigned-clocks = <&ov5648_xvclk 0>;
+ assigned-clock-rates = <24000000>;
+
+
+ ov5648_out: port {
+ ov5648_out_mipi_csi2: endpoint {
+ data-lanes = <1 2>;
+ link-frequencies = /bits/ 64 <210000000 168000000>;
+
+ remote-endpoint = <&mipi_csi2_in_ov5648>;
+ };
+ };
+ };
+ };
--
2.29.2
^ permalink raw reply related [flat|nested] 5+ messages in thread
* [PATCH v5 2/2] media: i2c: Add support for the OV5648 image sensor
2020-12-11 15:40 [PATCH v5 0/2] media: i2c: OV5648 image sensor support Paul Kocialkowski
2020-12-11 15:40 ` [PATCH v5 1/2] dt-bindings: media: i2c: Add OV5648 bindings documentation Paul Kocialkowski
@ 2020-12-11 15:40 ` Paul Kocialkowski
2020-12-20 22:39 ` Sakari Ailus
1 sibling, 1 reply; 5+ messages in thread
From: Paul Kocialkowski @ 2020-12-11 15:40 UTC (permalink / raw)
To: linux-media, devicetree, linux-kernel, linux-arm-kernel
Cc: Mauro Carvalho Chehab, Rob Herring, Maxime Ripard,
Paul Kocialkowski, Hans Verkuil, Sakari Ailus, Thomas Petazzoni
The OV5648 is a 5 Mpx CMOS image sensor, connected via MIPI CSI-2
in a one or two lane configuration.
Most of the features of the hardware are supported, including:
- Auto and manual exposition/gain
- Auto and manual white balance
- Horizontal and vertical flip
- Test patterns
But the following are still missing:
- Debanding, based on power source frequency;
- Exposition setting correlated to time units.
Signed-off-by: Paul Kocialkowski <paul.kocialkowski@bootlin.com>
---
drivers/media/i2c/Kconfig | 13 +
drivers/media/i2c/Makefile | 1 +
drivers/media/i2c/ov5648.c | 2638 ++++++++++++++++++++++++++++++++++++
3 files changed, 2652 insertions(+)
create mode 100644 drivers/media/i2c/ov5648.c
diff --git a/drivers/media/i2c/Kconfig b/drivers/media/i2c/Kconfig
index 878f66ef2719..c0470a8b9a80 100644
--- a/drivers/media/i2c/Kconfig
+++ b/drivers/media/i2c/Kconfig
@@ -922,6 +922,19 @@ config VIDEO_OV5647
To compile this driver as a module, choose M here: the
module will be called ov5647.
+config VIDEO_OV5648
+ tristate "OmniVision OV5648 sensor support"
+ depends on I2C && PM && VIDEO_V4L2
+ select MEDIA_CONTROLLER
+ select VIDEO_V4L2_SUBDEV_API
+ select V4L2_FWNODE
+ help
+ This is a Video4Linux2 sensor driver for the OmniVision
+ OV5648 camera.
+
+ To compile this driver as a module, choose M here: the
+ module will be called ov5648.
+
config VIDEO_OV6650
tristate "OmniVision OV6650 sensor support"
depends on I2C && VIDEO_V4L2
diff --git a/drivers/media/i2c/Makefile b/drivers/media/i2c/Makefile
index f0a77473979d..15d4d6382582 100644
--- a/drivers/media/i2c/Makefile
+++ b/drivers/media/i2c/Makefile
@@ -71,6 +71,7 @@ obj-$(CONFIG_VIDEO_OV2740) += ov2740.o
obj-$(CONFIG_VIDEO_OV5640) += ov5640.o
obj-$(CONFIG_VIDEO_OV5645) += ov5645.o
obj-$(CONFIG_VIDEO_OV5647) += ov5647.o
+obj-$(CONFIG_VIDEO_OV5648) += ov5648.o
obj-$(CONFIG_VIDEO_OV5670) += ov5670.o
obj-$(CONFIG_VIDEO_OV5675) += ov5675.o
obj-$(CONFIG_VIDEO_OV5695) += ov5695.o
diff --git a/drivers/media/i2c/ov5648.c b/drivers/media/i2c/ov5648.c
new file mode 100644
index 000000000000..4ae6b65ec258
--- /dev/null
+++ b/drivers/media/i2c/ov5648.c
@@ -0,0 +1,2638 @@
+// SPDX-License-Identifier: GPL-2.0-or-later
+/*
+ * Copyright (C) 2020 Bootlin
+ * Author: Paul Kocialkowski <paul.kocialkowski@bootlin.com>
+ */
+
+#include <linux/clk.h>
+#include <linux/delay.h>
+#include <linux/device.h>
+#include <linux/i2c.h>
+#include <linux/module.h>
+#include <linux/of_graph.h>
+#include <linux/pm_runtime.h>
+#include <linux/regulator/consumer.h>
+#include <linux/videodev2.h>
+#include <media/v4l2-ctrls.h>
+#include <media/v4l2-device.h>
+#include <media/v4l2-fwnode.h>
+#include <media/v4l2-image-sizes.h>
+#include <media/v4l2-mediabus.h>
+
+/* Clock rate */
+
+#define OV5648_XVCLK_RATE 24000000
+
+/* Register definitions */
+
+/* System */
+
+#define OV5648_SW_STANDBY_REG 0x100
+#define OV5648_SW_STANDBY_STREAM_ON BIT(0)
+
+#define OV5648_SW_RESET_REG 0x103
+#define OV5648_SW_RESET_RESET BIT(0)
+
+#define OV5648_PAD_OEN0_REG 0x3000
+#define OV5648_PAD_OEN1_REG 0x3001
+#define OV5648_PAD_OEN2_REG 0x3002
+#define OV5648_PAD_OUT0_REG 0x3008
+#define OV5648_PAD_OUT1_REG 0x3009
+
+#define OV5648_CHIP_ID_H_REG 0x300a
+#define OV5648_CHIP_ID_H_VALUE 0x56
+#define OV5648_CHIP_ID_L_REG 0x300b
+#define OV5648_CHIP_ID_L_VALUE 0x48
+
+#define OV5648_PAD_OUT2_REG 0x300d
+#define OV5648_PAD_SEL0_REG 0x300e
+#define OV5648_PAD_SEL1_REG 0x300f
+#define OV5648_PAD_SEL2_REG 0x3010
+#define OV5648_PAD_PK_REG 0x3011
+#define OV5648_PAD_PK_PD_DATO_EN BIT(7)
+#define OV5648_PAD_PK_DRIVE_STRENGTH_1X (0 << 5)
+#define OV5648_PAD_PK_DRIVE_STRENGTH_2X (2 << 5)
+#define OV5648_PAD_PK_FREX_N BIT(1)
+
+#define OV5648_A_PWC_PK_O0_REG 0x3013
+#define OV5648_A_PWC_PK_O0_BP_REGULATOR_N BIT(3)
+#define OV5648_A_PWC_PK_O1_REG 0x3014
+
+#define OV5648_MIPI_PHY0_REG 0x3016
+#define OV5648_MIPI_PHY1_REG 0x3017
+#define OV5648_MIPI_SC_CTRL0_REG 0x3018
+#define OV5648_MIPI_SC_CTRL0_MIPI_LANES(v) (((v) << 5) & GENMASK(7, 5))
+#define OV5648_MIPI_SC_CTRL0_PHY_HS_TX_PD BIT(4)
+#define OV5648_MIPI_SC_CTRL0_PHY_LP_RX_PD BIT(3)
+#define OV5648_MIPI_SC_CTRL0_MIPI_EN BIT(2)
+#define OV5648_MIPI_SC_CTRL0_MIPI_SUSP BIT(1)
+#define OV5648_MIPI_SC_CTRL0_LANE_DIS_OP BIT(0)
+#define OV5648_MIPI_SC_CTRL1_REG 0x3019
+#define OV5648_MISC_CTRL0_REG 0x3021
+#define OV5648_MIPI_SC_CTRL2_REG 0x3022
+#define OV5648_SUB_ID_REG 0x302a
+
+#define OV5648_PLL_CTRL0_REG 0x3034
+#define OV5648_PLL_CTRL0_PLL_CHARGE_PUMP(v) (((v) << 4) & GENMASK(6, 4))
+#define OV5648_PLL_CTRL0_BITS(v) ((v) & GENMASK(3, 0))
+#define OV5648_PLL_CTRL1_REG 0x3035
+#define OV5648_PLL_CTRL1_SYS_DIV(v) (((v) << 4) & GENMASK(7, 4))
+#define OV5648_PLL_CTRL1_MIPI_DIV(v) ((v) & GENMASK(3, 0))
+#define OV5648_PLL_MUL_REG 0x3036
+#define OV5648_PLL_MUL(v) ((v) & GENMASK(7, 0))
+#define OV5648_PLL_DIV_REG 0x3037
+#define OV5648_PLL_DIV_ROOT_DIV(v) ((((v) - 1) << 4) & BIT(4))
+#define OV5648_PLL_DIV_PLL_PRE_DIV(v) ((v) & GENMASK(3, 0))
+#define OV5648_PLL_DEBUG_REG 0x3038
+#define OV5648_PLL_BYPASS_REG 0x3039
+
+#define OV5648_PLLS_BYPASS_REG 0x303a
+#define OV5648_PLLS_MUL_REG 0x303b
+#define OV5648_PLLS_MUL(v) ((v) & GENMASK(4, 0))
+#define OV5648_PLLS_CTRL_REG 0x303c
+#define OV5648_PLLS_CTRL_PLL_CHARGE_PUMP(v) (((v) << 4) & GENMASK(6, 4))
+#define OV5648_PLLS_CTRL_SYS_DIV(v) ((v) & GENMASK(3, 0))
+#define OV5648_PLLS_DIV_REG 0x303d
+#define OV5648_PLLS_DIV_PLLS_PRE_DIV(v) (((v) << 4) & GENMASK(5, 4))
+#define OV5648_PLLS_DIV_PLLS_DIV_R(v) ((((v) - 1) << 2) & BIT(2))
+#define OV5648_PLLS_DIV_PLLS_SEL_DIV(v) ((v) & GENMASK(1, 0))
+
+#define OV5648_SRB_CTRL_REG 0x3106
+#define OV5648_SRB_CTRL_SCLK_DIV(v) (((v) << 2) & GENMASK(3, 2))
+#define OV5648_SRB_CTRL_RESET_ARBITER_EN BIT(1)
+#define OV5648_SRB_CTRL_SCLK_ARBITER_EN BIT(0)
+
+/* Group Hold */
+
+#define OV5648_GROUP_ADR0_REG 0x3200
+#define OV5648_GROUP_ADR1_REG 0x3201
+#define OV5648_GROUP_ADR2_REG 0x3202
+#define OV5648_GROUP_ADR3_REG 0x3203
+#define OV5648_GROUP_LEN0_REG 0x3204
+#define OV5648_GROUP_LEN1_REG 0x3205
+#define OV5648_GROUP_LEN2_REG 0x3206
+#define OV5648_GROUP_LEN3_REG 0x3207
+#define OV5648_GROUP_ACCESS_REG 0x3208
+
+/* Exposure/gain/banding */
+
+#define OV5648_EXPOSURE_CTRL_HH_REG 0x3500
+#define OV5648_EXPOSURE_CTRL_HH(v) (((v) & GENMASK(19, 16)) >> 16)
+#define OV5648_EXPOSURE_CTRL_HH_VALUE(v) (((v) << 16) & GENMASK(19, 16))
+#define OV5648_EXPOSURE_CTRL_H_REG 0x3501
+#define OV5648_EXPOSURE_CTRL_H(v) (((v) & GENMASK(15, 8)) >> 8)
+#define OV5648_EXPOSURE_CTRL_H_VALUE(v) (((v) << 8) & GENMASK(15, 8))
+#define OV5648_EXPOSURE_CTRL_L_REG 0x3502
+#define OV5648_EXPOSURE_CTRL_L(v) ((v) & GENMASK(7, 0))
+#define OV5648_EXPOSURE_CTRL_L_VALUE(v) ((v) & GENMASK(7, 0))
+#define OV5648_MANUAL_CTRL_REG 0x3503
+#define OV5648_MANUAL_CTRL_FRAME_DELAY(v) (((v) << 4) & GENMASK(5, 4))
+#define OV5648_MANUAL_CTRL_AGC_MANUAL_EN BIT(1)
+#define OV5648_MANUAL_CTRL_AEC_MANUAL_EN BIT(0)
+#define OV5648_GAIN_CTRL_H_REG 0x350a
+#define OV5648_GAIN_CTRL_H(v) (((v) & GENMASK(9, 8)) >> 8)
+#define OV5648_GAIN_CTRL_H_VALUE(v) (((v) << 8) & GENMASK(9, 8))
+#define OV5648_GAIN_CTRL_L_REG 0x350b
+#define OV5648_GAIN_CTRL_L(v) ((v) & GENMASK(7, 0))
+#define OV5648_GAIN_CTRL_L_VALUE(v) ((v) & GENMASK(7, 0))
+
+#define OV5648_ANALOG_CTRL0_REG_BASE 0x3600
+#define OV5648_ANALOG_CTRL1_REG_BASE 0x3700
+
+#define OV5648_AEC_CTRL0_REG 0x3a00
+#define OV5648_AEC_CTRL0_DEBUG BIT(6)
+#define OV5648_AEC_CTRL0_DEBAND_EN BIT(5)
+#define OV5648_AEC_CTRL0_DEBAND_LOW_LIMIT_EN BIT(4)
+#define OV5648_AEC_CTRL0_START_SEL_EN BIT(3)
+#define OV5648_AEC_CTRL0_NIGHT_MODE_EN BIT(2)
+#define OV5648_AEC_CTRL0_FREEZE_EN BIT(0)
+#define OV5648_EXPOSURE_MIN_REG 0x3a01
+#define OV5648_EXPOSURE_MAX_60_H_REG 0x3a02
+#define OV5648_EXPOSURE_MAX_60_L_REG 0x3a03
+#define OV5648_AEC_CTRL5_REG 0x3a05
+#define OV5648_AEC_CTRL6_REG 0x3a06
+#define OV5648_AEC_CTRL7_REG 0x3a07
+#define OV5648_BANDING_STEP_50_H_REG 0x3a08
+#define OV5648_BANDING_STEP_50_L_REG 0x3a09
+#define OV5648_BANDING_STEP_60_H_REG 0x3a0a
+#define OV5648_BANDING_STEP_60_L_REG 0x3a0b
+#define OV5648_AEC_CTRLC_REG 0x3a0c
+#define OV5648_BANDING_MAX_60_REG 0x3a0d
+#define OV5648_BANDING_MAX_50_REG 0x3a0e
+#define OV5648_WPT_REG 0x3a0f
+#define OV5648_BPT_REG 0x3a10
+#define OV5648_VPT_HIGH_REG 0x3a11
+#define OV5648_AVG_MANUAL_REG 0x3a12
+#define OV5648_PRE_GAIN_REG 0x3a13
+#define OV5648_EXPOSURE_MAX_50_H_REG 0x3a14
+#define OV5648_EXPOSURE_MAX_50_L_REG 0x3a15
+#define OV5648_GAIN_BASE_NIGHT_REG 0x3a17
+#define OV5648_AEC_GAIN_CEILING_H_REG 0x3a18
+#define OV5648_AEC_GAIN_CEILING_L_REG 0x3a19
+#define OV5648_DIFF_MAX_REG 0x3a1a
+#define OV5648_WPT2_REG 0x3a1b
+#define OV5648_LED_ADD_ROW_H_REG 0x3a1c
+#define OV5648_LED_ADD_ROW_L_REG 0x3a1d
+#define OV5648_BPT2_REG 0x3a1e
+#define OV5648_VPT_LOW_REG 0x3a1f
+#define OV5648_AEC_CTRL20_REG 0x3a20
+#define OV5648_AEC_CTRL21_REG 0x3a21
+
+#define OV5648_AVG_START_X_H_REG 0x5680
+#define OV5648_AVG_START_X_L_REG 0x5681
+#define OV5648_AVG_START_Y_H_REG 0x5682
+#define OV5648_AVG_START_Y_L_REG 0x5683
+#define OV5648_AVG_WINDOW_X_H_REG 0x5684
+#define OV5648_AVG_WINDOW_X_L_REG 0x5685
+#define OV5648_AVG_WINDOW_Y_H_REG 0x5686
+#define OV5648_AVG_WINDOW_Y_L_REG 0x5687
+#define OV5648_AVG_WEIGHT00_REG 0x5688
+#define OV5648_AVG_WEIGHT01_REG 0x5689
+#define OV5648_AVG_WEIGHT02_REG 0x568a
+#define OV5648_AVG_WEIGHT03_REG 0x568b
+#define OV5648_AVG_WEIGHT04_REG 0x568c
+#define OV5648_AVG_WEIGHT05_REG 0x568d
+#define OV5648_AVG_WEIGHT06_REG 0x568e
+#define OV5648_AVG_WEIGHT07_REG 0x568f
+#define OV5648_AVG_CTRL10_REG 0x5690
+#define OV5648_AVG_WEIGHT_SUM_REG 0x5691
+#define OV5648_AVG_READOUT_REG 0x5693
+
+#define OV5648_DIG_CTRL0_REG 0x5a00
+#define OV5648_DIG_COMP_MAN_H_REG 0x5a02
+#define OV5648_DIG_COMP_MAN_L_REG 0x5a03
+
+#define OV5648_GAINC_MAN_H_REG 0x5a20
+#define OV5648_GAINC_MAN_L_REG 0x5a21
+#define OV5648_GAINC_DGC_MAN_H_REG 0x5a22
+#define OV5648_GAINC_DGC_MAN_L_REG 0x5a23
+#define OV5648_GAINC_CTRL0_REG 0x5a24
+
+#define OV5648_GAINF_ANA_NUM_REG 0x5a40
+#define OV5648_GAINF_DIG_GAIN_REG 0x5a41
+
+/* Timing */
+
+#define OV5648_CROP_START_X_H_REG 0x3800
+#define OV5648_CROP_START_X_H(v) (((v) & GENMASK(11, 8)) >> 8)
+#define OV5648_CROP_START_X_L_REG 0x3801
+#define OV5648_CROP_START_X_L(v) ((v) & GENMASK(7, 0))
+#define OV5648_CROP_START_Y_H_REG 0x3802
+#define OV5648_CROP_START_Y_H(v) (((v) & GENMASK(11, 8)) >> 8)
+#define OV5648_CROP_START_Y_L_REG 0x3803
+#define OV5648_CROP_START_Y_L(v) ((v) & GENMASK(7, 0))
+#define OV5648_CROP_END_X_H_REG 0x3804
+#define OV5648_CROP_END_X_H(v) (((v) & GENMASK(11, 8)) >> 8)
+#define OV5648_CROP_END_X_L_REG 0x3805
+#define OV5648_CROP_END_X_L(v) ((v) & GENMASK(7, 0))
+#define OV5648_CROP_END_Y_H_REG 0x3806
+#define OV5648_CROP_END_Y_H(v) (((v) & GENMASK(11, 8)) >> 8)
+#define OV5648_CROP_END_Y_L_REG 0x3807
+#define OV5648_CROP_END_Y_L(v) ((v) & GENMASK(7, 0))
+#define OV5648_OUTPUT_SIZE_X_H_REG 0x3808
+#define OV5648_OUTPUT_SIZE_X_H(v) (((v) & GENMASK(11, 8)) >> 8)
+#define OV5648_OUTPUT_SIZE_X_L_REG 0x3809
+#define OV5648_OUTPUT_SIZE_X_L(v) ((v) & GENMASK(7, 0))
+#define OV5648_OUTPUT_SIZE_Y_H_REG 0x380a
+#define OV5648_OUTPUT_SIZE_Y_H(v) (((v) & GENMASK(11, 8)) >> 8)
+#define OV5648_OUTPUT_SIZE_Y_L_REG 0x380b
+#define OV5648_OUTPUT_SIZE_Y_L(v) ((v) & GENMASK(7, 0))
+#define OV5648_HTS_H_REG 0x380c
+#define OV5648_HTS_H(v) (((v) & GENMASK(12, 8)) >> 8)
+#define OV5648_HTS_L_REG 0x380d
+#define OV5648_HTS_L(v) ((v) & GENMASK(7, 0))
+#define OV5648_VTS_H_REG 0x380e
+#define OV5648_VTS_H(v) (((v) & GENMASK(15, 8)) >> 8)
+#define OV5648_VTS_L_REG 0x380f
+#define OV5648_VTS_L(v) ((v) & GENMASK(7, 0))
+#define OV5648_OFFSET_X_H_REG 0x3810
+#define OV5648_OFFSET_X_H(v) (((v) & GENMASK(11, 8)) >> 8)
+#define OV5648_OFFSET_X_L_REG 0x3811
+#define OV5648_OFFSET_X_L(v) ((v) & GENMASK(7, 0))
+#define OV5648_OFFSET_Y_H_REG 0x3812
+#define OV5648_OFFSET_Y_H(v) (((v) & GENMASK(11, 8)) >> 8)
+#define OV5648_OFFSET_Y_L_REG 0x3813
+#define OV5648_OFFSET_Y_L(v) ((v) & GENMASK(7, 0))
+#define OV5648_SUB_INC_X_REG 0x3814
+#define OV5648_SUB_INC_X_ODD(v) (((v) << 4) & GENMASK(7, 4))
+#define OV5648_SUB_INC_X_EVEN(v) ((v) & GENMASK(3, 0))
+#define OV5648_SUB_INC_Y_REG 0x3815
+#define OV5648_SUB_INC_Y_ODD(v) (((v) << 4) & GENMASK(7, 4))
+#define OV5648_SUB_INC_Y_EVEN(v) ((v) & GENMASK(3, 0))
+#define OV5648_HSYNCST_H_REG 0x3816
+#define OV5648_HSYNCST_H(v) (((v) >> 8) & 0xf)
+#define OV5648_HSYNCST_L_REG 0x3817
+#define OV5648_HSYNCST_L(v) ((v) & GENMASK(7, 0))
+#define OV5648_HSYNCW_H_REG 0x3818
+#define OV5648_HSYNCW_H(v) (((v) >> 8) & 0xf)
+#define OV5648_HSYNCW_L_REG 0x3819
+#define OV5648_HSYNCW_L(v) ((v) & GENMASK(7, 0))
+
+#define OV5648_TC20_REG 0x3820
+#define OV5648_TC20_DEBUG BIT(6)
+#define OV5648_TC20_FLIP_VERT_ISP_EN BIT(2)
+#define OV5648_TC20_FLIP_VERT_SENSOR_EN BIT(1)
+#define OV5648_TC20_BINNING_VERT_EN BIT(0)
+#define OV5648_TC21_REG 0x3821
+#define OV5648_TC21_FLIP_HORZ_ISP_EN BIT(2)
+#define OV5648_TC21_FLIP_HORZ_SENSOR_EN BIT(1)
+#define OV5648_TC21_BINNING_HORZ_EN BIT(0)
+
+/* Strobe/exposure */
+
+#define OV5648_STROBE_REG 0x3b00
+#define OV5648_FREX_EXP_HH_REG 0x3b01
+#define OV5648_SHUTTER_DLY_H_REG 0x3b02
+#define OV5648_SHUTTER_DLY_L_REG 0x3b03
+#define OV5648_FREX_EXP_H_REG 0x3b04
+#define OV5648_FREX_EXP_L_REG 0x3b05
+#define OV5648_FREX_CTRL_REG 0x3b06
+#define OV5648_FREX_MODE_SEL_REG 0x3b07
+#define OV5648_FREX_MODE_SEL_FREX_SA1 BIT(4)
+#define OV5648_FREX_MODE_SEL_FX1_FM_EN BIT(3)
+#define OV5648_FREX_MODE_SEL_FREX_INV BIT(2)
+#define OV5648_FREX_MODE_SEL_MODE1 0x0
+#define OV5648_FREX_MODE_SEL_MODE2 0x1
+#define OV5648_FREX_MODE_SEL_ROLLING 0x2
+#define OV5648_FREX_EXP_REQ_REG 0x3b08
+#define OV5648_FREX_SHUTTER_DLY_REG 0x3b09
+#define OV5648_FREX_RST_LEN_REG 0x3b0a
+#define OV5648_STROBE_WIDTH_HH_REG 0x3b0b
+#define OV5648_STROBE_WIDTH_H_REG 0x3b0c
+
+/* OTP */
+
+#define OV5648_OTP_DATA_REG_BASE 0x3d00
+#define OV5648_OTP_PROGRAM_CTRL_REG 0x3d80
+#define OV5648_OTP_LOAD_CTRL_REG 0x3d81
+
+/* PSRAM */
+
+#define OV5648_PSRAM_CTRL1_REG 0x3f01
+#define OV5648_PSRAM_CTRLF_REG 0x3f0f
+
+/* Black Level */
+
+#define OV5648_BLC_CTRL0_REG 0x4000
+#define OV5648_BLC_CTRL1_REG 0x4001
+#define OV5648_BLC_CTRL1_START_LINE(v) ((v) & GENMASK(5, 0))
+#define OV5648_BLC_CTRL2_REG 0x4002
+#define OV5648_BLC_CTRL2_AUTO_EN BIT(6)
+#define OV5648_BLC_CTRL2_RESET_FRAME_NUM(v) ((v) & GENMASK(5, 0))
+#define OV5648_BLC_CTRL3_REG 0x4003
+#define OV5648_BLC_LINE_NUM_REG 0x4004
+#define OV5648_BLC_LINE_NUM(v) ((v) & GENMASK(7, 0))
+#define OV5648_BLC_CTRL5_REG 0x4005
+#define OV5648_BLC_CTRL5_UPDATE_EN BIT(1)
+#define OV5648_BLC_LEVEL_REG 0x4009
+
+/* Frame */
+
+#define OV5648_FRAME_CTRL_REG 0x4200
+#define OV5648_FRAME_ON_NUM_REG 0x4201
+#define OV5648_FRAME_OFF_NUM_REG 0x4202
+
+/* MIPI CSI-2 */
+
+#define OV5648_MIPI_CTRL0_REG 0x4800
+#define OV5648_MIPI_CTRL0_CLK_LANE_AUTOGATE BIT(5)
+#define OV5648_MIPI_CTRL0_LANE_SYNC_EN BIT(4)
+#define OV5648_MIPI_CTRL0_LANE_SELECT_LANE1 0
+#define OV5648_MIPI_CTRL0_LANE_SELECT_LANE2 BIT(3)
+#define OV5648_MIPI_CTRL0_IDLE_LP00 0
+#define OV5648_MIPI_CTRL0_IDLE_LP11 BIT(2)
+
+#define OV5648_MIPI_CTRL1_REG 0x4801
+#define OV5648_MIPI_CTRL2_REG 0x4802
+#define OV5648_MIPI_CTRL3_REG 0x4803
+#define OV5648_MIPI_CTRL4_REG 0x4804
+#define OV5648_MIPI_CTRL5_REG 0x4805
+#define OV5648_MIPI_MAX_FRAME_COUNT_H_REG 0x4810
+#define OV5648_MIPI_MAX_FRAME_COUNT_L_REG 0x4811
+#define OV5648_MIPI_CTRL14_REG 0x4814
+#define OV5648_MIPI_DT_SPKT_REG 0x4815
+#define OV5648_MIPI_HS_ZERO_MIN_H_REG 0x4818
+#define OV5648_MIPI_HS_ZERO_MIN_L_REG 0x4819
+#define OV5648_MIPI_HS_TRAIN_MIN_H_REG 0x481a
+#define OV5648_MIPI_HS_TRAIN_MIN_L_REG 0x481b
+#define OV5648_MIPI_CLK_ZERO_MIN_H_REG 0x481c
+#define OV5648_MIPI_CLK_ZERO_MIN_L_REG 0x481d
+#define OV5648_MIPI_CLK_PREPARE_MIN_H_REG 0x481e
+#define OV5648_MIPI_CLK_PREPARE_MIN_L_REG 0x481f
+#define OV5648_MIPI_CLK_POST_MIN_H_REG 0x4820
+#define OV5648_MIPI_CLK_POST_MIN_L_REG 0x4821
+#define OV5648_MIPI_CLK_TRAIL_MIN_H_REG 0x4822
+#define OV5648_MIPI_CLK_TRAIL_MIN_L_REG 0x4823
+#define OV5648_MIPI_LPX_P_MIN_H_REG 0x4824
+#define OV5648_MIPI_LPX_P_MIN_L_REG 0x4825
+#define OV5648_MIPI_HS_PREPARE_MIN_H_REG 0x4826
+#define OV5648_MIPI_HS_PREPARE_MIN_L_REG 0x4827
+#define OV5648_MIPI_HS_EXIT_MIN_H_REG 0x4828
+#define OV5648_MIPI_HS_EXIT_MIN_L_REG 0x4829
+#define OV5648_MIPI_HS_ZERO_MIN_UI_REG 0x482a
+#define OV5648_MIPI_HS_TRAIL_MIN_UI_REG 0x482b
+#define OV5648_MIPI_CLK_ZERO_MIN_UI_REG 0x482c
+#define OV5648_MIPI_CLK_PREPARE_MIN_UI_REG 0x482d
+#define OV5648_MIPI_CLK_POST_MIN_UI_REG 0x482e
+#define OV5648_MIPI_CLK_TRAIL_MIN_UI_REG 0x482f
+#define OV5648_MIPI_LPX_P_MIN_UI_REG 0x4830
+#define OV5648_MIPI_HS_PREPARE_MIN_UI_REG 0x4831
+#define OV5648_MIPI_HS_EXIT_MIN_UI_REG 0x4832
+#define OV5648_MIPI_REG_MIN_H_REG 0x4833
+#define OV5648_MIPI_REG_MIN_L_REG 0x4834
+#define OV5648_MIPI_REG_MAX_H_REG 0x4835
+#define OV5648_MIPI_REG_MAX_L_REG 0x4836
+#define OV5648_MIPI_PCLK_PERIOD_REG 0x4837
+#define OV5648_MIPI_WKUP_DLY_REG 0x4838
+#define OV5648_MIPI_LP_GPIO_REG 0x483b
+#define OV5648_MIPI_SNR_PCLK_DIV_REG 0x4843
+
+/* ISP */
+
+#define OV5648_ISP_CTRL0_REG 0x5000
+#define OV5648_ISP_CTRL0_BLACK_CORRECT_EN BIT(2)
+#define OV5648_ISP_CTRL0_WHITE_CORRECT_EN BIT(1)
+#define OV5648_ISP_CTRL1_REG 0x5001
+#define OV5648_ISP_CTRL1_AWB_EN BIT(0)
+#define OV5648_ISP_CTRL2_REG 0x5002
+#define OV5648_ISP_CTRL2_WIN_EN BIT(6)
+#define OV5648_ISP_CTRL2_OTP_EN BIT(1)
+#define OV5648_ISP_CTRL2_AWB_GAIN_EN BIT(0)
+#define OV5648_ISP_CTRL3_REG 0x5003
+#define OV5648_ISP_CTRL3_BUF_EN BIT(3)
+#define OV5648_ISP_CTRL3_BIN_MAN_SET BIT(2)
+#define OV5648_ISP_CTRL3_BIN_AUTO_EN BIT(1)
+#define OV5648_ISP_CTRL4_REG 0x5004
+#define OV5648_ISP_CTRL5_REG 0x5005
+#define OV5648_ISP_CTRL6_REG 0x5006
+#define OV5648_ISP_CTRL7_REG 0x5007
+#define OV5648_ISP_MAN_OFFSET_X_H_REG 0x5008
+#define OV5648_ISP_MAN_OFFSET_X_L_REG 0x5009
+#define OV5648_ISP_MAN_OFFSET_Y_H_REG 0x500a
+#define OV5648_ISP_MAN_OFFSET_Y_L_REG 0x500b
+#define OV5648_ISP_MAN_WIN_OFFSET_X_H_REG 0x500c
+#define OV5648_ISP_MAN_WIN_OFFSET_X_L_REG 0x500d
+#define OV5648_ISP_MAN_WIN_OFFSET_Y_H_REG 0x500e
+#define OV5648_ISP_MAN_WIN_OFFSET_Y_L_REG 0x500f
+#define OV5648_ISP_MAN_WIN_OUTPUT_X_H_REG 0x5010
+#define OV5648_ISP_MAN_WIN_OUTPUT_X_L_REG 0x5011
+#define OV5648_ISP_MAN_WIN_OUTPUT_Y_H_REG 0x5012
+#define OV5648_ISP_MAN_WIN_OUTPUT_Y_L_REG 0x5013
+#define OV5648_ISP_MAN_INPUT_X_H_REG 0x5014
+#define OV5648_ISP_MAN_INPUT_X_L_REG 0x5015
+#define OV5648_ISP_MAN_INPUT_Y_H_REG 0x5016
+#define OV5648_ISP_MAN_INPUT_Y_L_REG 0x5017
+#define OV5648_ISP_CTRL18_REG 0x5018
+#define OV5648_ISP_CTRL19_REG 0x5019
+#define OV5648_ISP_CTRL1A_REG 0x501a
+#define OV5648_ISP_CTRL1D_REG 0x501d
+#define OV5648_ISP_CTRL1F_REG 0x501f
+#define OV5648_ISP_CTRL1F_OUTPUT_EN 3
+#define OV5648_ISP_CTRL25_REG 0x5025
+
+#define OV5648_ISP_CTRL3D_REG 0x503d
+#define OV5648_ISP_CTRL3D_PATTERN_EN BIT(7)
+#define OV5648_ISP_CTRL3D_ROLLING_BAR_EN BIT(6)
+#define OV5648_ISP_CTRL3D_TRANSPARENT_MODE BIT(5)
+#define OV5648_ISP_CTRL3D_SQUARES_BW_MODE BIT(4)
+#define OV5648_ISP_CTRL3D_PATTERN_COLOR_BARS 0
+#define OV5648_ISP_CTRL3D_PATTERN_RANDOM_DATA 1
+#define OV5648_ISP_CTRL3D_PATTERN_COLOR_SQUARES 2
+#define OV5648_ISP_CTRL3D_PATTERN_INPUT 3
+
+#define OV5648_ISP_CTRL3E_REG 0x503e
+#define OV5648_ISP_CTRL4B_REG 0x504b
+#define OV5648_ISP_CTRL4B_POST_BIN_H_EN BIT(5)
+#define OV5648_ISP_CTRL4B_POST_BIN_V_EN BIT(4)
+#define OV5648_ISP_CTRL4C_REG 0x504c
+#define OV5648_ISP_CTRL57_REG 0x5057
+#define OV5648_ISP_CTRL58_REG 0x5058
+#define OV5648_ISP_CTRL59_REG 0x5059
+
+#define OV5648_ISP_WINDOW_START_X_H_REG 0x5980
+#define OV5648_ISP_WINDOW_START_X_L_REG 0x5981
+#define OV5648_ISP_WINDOW_START_Y_H_REG 0x5982
+#define OV5648_ISP_WINDOW_START_Y_L_REG 0x5983
+#define OV5648_ISP_WINDOW_WIN_X_H_REG 0x5984
+#define OV5648_ISP_WINDOW_WIN_X_L_REG 0x5985
+#define OV5648_ISP_WINDOW_WIN_Y_H_REG 0x5986
+#define OV5648_ISP_WINDOW_WIN_Y_L_REG 0x5987
+#define OV5648_ISP_WINDOW_MAN_REG 0x5988
+
+/* White Balance */
+
+#define OV5648_AWB_CTRL_REG 0x5180
+#define OV5648_AWB_CTRL_FAST_AWB BIT(6)
+#define OV5648_AWB_CTRL_GAIN_FREEZE_EN BIT(5)
+#define OV5648_AWB_CTRL_SUM_FREEZE_EN BIT(4)
+#define OV5648_AWB_CTRL_GAIN_MANUAL_EN BIT(3)
+
+#define OV5648_AWB_DELTA_REG 0x5181
+#define OV5648_AWB_STABLE_RANGE_REG 0x5182
+#define OV5648_AWB_STABLE_RANGE_WIDE_REG 0x5183
+#define OV5648_HSIZE_MAN_REG 0x5185
+
+#define OV5648_GAIN_RED_MAN_H_REG 0x5186
+#define OV5648_GAIN_RED_MAN_H(v) (((v) & GENMASK(11, 8)) >> 8)
+#define OV5648_GAIN_RED_MAN_L_REG 0x5187
+#define OV5648_GAIN_RED_MAN_L(v) ((v) & GENMASK(7, 0))
+#define OV5648_GAIN_GREEN_MAN_H_REG 0x5188
+#define OV5648_GAIN_GREEN_MAN_H(v) (((v) & GENMASK(11, 8)) >> 8)
+#define OV5648_GAIN_GREEN_MAN_L_REG 0x5189
+#define OV5648_GAIN_GREEN_MAN_L(v) ((v) & GENMASK(7, 0))
+#define OV5648_GAIN_BLUE_MAN_H_REG 0x518a
+#define OV5648_GAIN_BLUE_MAN_H(v) (((v) & GENMASK(11, 8)) >> 8)
+#define OV5648_GAIN_BLUE_MAN_L_REG 0x518b
+#define OV5648_GAIN_BLUE_MAN_L(v) ((v) & GENMASK(7, 0))
+#define OV5648_GAIN_RED_LIMIT_REG 0x518c
+#define OV5648_GAIN_GREEN_LIMIT_REG 0x518d
+#define OV5648_GAIN_BLUE_LIMIT_REG 0x518e
+#define OV5648_AWB_FRAME_COUNT_REG 0x518f
+#define OV5648_AWB_BASE_MAN_REG 0x51df
+
+/* Macros */
+
+#define ov5648_subdev_sensor(subdev) \
+ container_of(subdev, struct ov5648_sensor, subdev)
+
+#define ov5648_ctrl_subdev(ctrl) \
+ (&container_of(ctrl->handler, struct ov5648_sensor, ctrls.handler)->subdev)
+
+/* Data structures */
+
+struct ov5648_register_value {
+ u16 address;
+ u8 value;
+ unsigned int delay_ms;
+};
+
+/*
+ * PLL1 Clock Tree:
+ *
+ * +-< XVCLK
+ * |
+ * +-+ pll_pre_div (0x3037 [3:0], special values: 5: 1.5, 7: 2.5)
+ * |
+ * +-+ pll_mul (0x3036 [7:0])
+ * |
+ * +-+ sys_div (0x3035 [7:4])
+ * |
+ * +-+ mipi_div (0x3035 [3:0])
+ * | |
+ * | +-> MIPI_SCLK
+ * | |
+ * | +-+ mipi_phy_div (2)
+ * | |
+ * | +-> MIPI_CLK
+ * |
+ * +-+ root_div (0x3037 [4])
+ * |
+ * +-+ bit_div (0x3034 [3:0], 8 bits: 2, 10 bits: 2.5, other: 1)
+ * |
+ * +-+ sclk_div (0x3106 [3:2])
+ * |
+ * +-> SCLK
+ * |
+ * +-+ mipi_div (0x3035, 1: PCLK = SCLK)
+ * |
+ * +-> PCLK
+ */
+
+struct ov5648_pll1_config {
+ unsigned int pll_pre_div;
+ unsigned int pll_mul;
+ unsigned int sys_div;
+ unsigned int root_div;
+ unsigned int sclk_div;
+ unsigned int mipi_div;
+};
+
+/*
+ * PLL2 Clock Tree:
+ *
+ * +-< XVCLK
+ * |
+ * +-+ plls_pre_div (0x303d [5:4], special values: 0: 1, 1: 1.5)
+ * |
+ * +-+ plls_div_r (0x303d [2])
+ * |
+ * +-+ plls_mul (0x303b [4:0])
+ * |
+ * +-+ sys_div (0x303c [3:0])
+ * |
+ * +-+ sel_div (0x303d [1:0], special values: 0: 1, 3: 2.5)
+ * |
+ * +-> ADCLK
+ */
+
+struct ov5648_pll2_config {
+ unsigned int plls_pre_div;
+ unsigned int plls_div_r;
+ unsigned int plls_mul;
+ unsigned int sys_div;
+ unsigned int sel_div;
+};
+
+/*
+ * General formulas for (array-centered) mode calculation:
+ * - photo_array_width = 2624
+ * - crop_start_x = (photo_array_width - output_size_x) / 2
+ * - crop_end_x = crop_start_x + offset_x + output_size_x - 1
+ *
+ * - photo_array_height = 1956
+ * - crop_start_y = (photo_array_height - output_size_y) / 2
+ * - crop_end_y = crop_start_y + offset_y + output_size_y - 1
+ */
+
+struct ov5648_mode {
+ unsigned int crop_start_x;
+ unsigned int offset_x;
+ unsigned int output_size_x;
+ unsigned int crop_end_x;
+ unsigned int hts;
+
+ unsigned int crop_start_y;
+ unsigned int offset_y;
+ unsigned int output_size_y;
+ unsigned int crop_end_y;
+ unsigned int vts;
+
+ bool binning_x;
+ bool binning_y;
+
+ unsigned int inc_x_odd;
+ unsigned int inc_x_even;
+ unsigned int inc_y_odd;
+ unsigned int inc_y_even;
+
+ /* 8-bit frame interval followed by 10-bit frame interval. */
+ struct v4l2_fract frame_interval[2];
+
+ /* 8-bit config followed by 10-bit config. */
+ const struct ov5648_pll1_config *pll1_config[2];
+ const struct ov5648_pll2_config *pll2_config;
+
+ const struct ov5648_register_value *register_values;
+ unsigned int register_values_count;
+};
+
+struct ov5648_state {
+ const struct ov5648_mode *mode;
+ u32 mbus_code;
+
+ bool streaming;
+};
+
+struct ov5648_ctrls {
+ struct v4l2_ctrl *exposure_auto;
+ struct v4l2_ctrl *exposure;
+
+ struct v4l2_ctrl *gain_auto;
+ struct v4l2_ctrl *gain;
+
+ struct v4l2_ctrl *white_balance_auto;
+ struct v4l2_ctrl *red_balance;
+ struct v4l2_ctrl *blue_balance;
+
+ struct v4l2_ctrl *link_freq;
+ struct v4l2_ctrl *pixel_rate;
+
+ struct v4l2_ctrl_handler handler;
+} __packed;
+
+struct ov5648_sensor {
+ struct device *dev;
+ struct i2c_client *i2c_client;
+ struct gpio_desc *reset;
+ struct gpio_desc *powerdown;
+ struct regulator *avdd;
+ struct regulator *dvdd;
+ struct regulator *dovdd;
+ struct clk *xvclk;
+
+ struct v4l2_fwnode_endpoint endpoint;
+ struct v4l2_subdev subdev;
+ struct media_pad pad;
+
+ struct mutex mutex;
+
+ struct ov5648_state state;
+ struct ov5648_ctrls ctrls;
+};
+
+/* Static definitions */
+
+/*
+ * XVCLK = 24 MHz
+ * SCLK = 84 MHz
+ * PCLK = 84 MHz
+ */
+static const struct ov5648_pll1_config ov5648_pll1_config_native_8_bits = {
+ .pll_pre_div = 3,
+ .pll_mul = 84,
+ .sys_div = 2,
+ .root_div = 1,
+ .sclk_div = 1,
+ .mipi_div = 1,
+};
+
+/*
+ * XVCLK = 24 MHz
+ * SCLK = 84 MHz
+ * PCLK = 84 MHz
+ */
+static const struct ov5648_pll1_config ov5648_pll1_config_native_10_bits = {
+ .pll_pre_div = 3,
+ .pll_mul = 105,
+ .sys_div = 2,
+ .root_div = 1,
+ .sclk_div = 1,
+ .mipi_div = 1,
+};
+
+/*
+ * XVCLK = 24 MHz
+ * ADCLK = 200 MHz
+ */
+static const struct ov5648_pll2_config ov5648_pll2_config_native = {
+ .plls_pre_div = 3,
+ .plls_div_r = 1,
+ .plls_mul = 25,
+ .sys_div = 1,
+ .sel_div = 1,
+};
+
+static const struct ov5648_mode ov5648_modes[] = {
+ /* 2592x1944 */
+ {
+ /* Horizontal */
+ .crop_start_x = 16,
+ .offset_x = 0,
+ .output_size_x = 2592,
+ .crop_end_x = 2607,
+ .hts = 2816,
+
+ /* Vertical */
+ .crop_start_y = 6,
+ .offset_y = 0,
+ .output_size_y = 1944,
+ .crop_end_y = 1949,
+ .vts = 1984,
+
+ /* Subsample increase */
+ .inc_x_odd = 1,
+ .inc_x_even = 1,
+ .inc_y_odd = 1,
+ .inc_y_even = 1,
+
+ /* Frame Interval */
+ .frame_interval = {
+ { 1, 15 },
+ { 1, 15 },
+ },
+
+ /* PLL */
+ .pll1_config = {
+ &ov5648_pll1_config_native_8_bits,
+ &ov5648_pll1_config_native_10_bits,
+ },
+ .pll2_config = &ov5648_pll2_config_native,
+ },
+ /* 1600x1200 (UXGA) */
+ {
+ /* Horizontal */
+ .crop_start_x = 512,
+ .offset_x = 0,
+ .output_size_x = 1600,
+ .crop_end_x = 2111,
+ .hts = 2816,
+
+ /* Vertical */
+ .crop_start_y = 378,
+ .offset_y = 0,
+ .output_size_y = 1200,
+ .crop_end_y = 1577,
+ .vts = 1984,
+
+ /* Subsample increase */
+ .inc_x_odd = 1,
+ .inc_x_even = 1,
+ .inc_y_odd = 1,
+ .inc_y_even = 1,
+
+ /* Frame Interval */
+ .frame_interval = {
+ { 1, 15 },
+ { 1, 15 },
+ },
+
+ /* PLL */
+ .pll1_config = {
+ &ov5648_pll1_config_native_8_bits,
+ &ov5648_pll1_config_native_10_bits,
+ },
+ .pll2_config = &ov5648_pll2_config_native,
+ },
+ /* 1920x1080 (Full HD) */
+ {
+ /* Horizontal */
+ .crop_start_x = 352,
+ .offset_x = 0,
+ .output_size_x = 1920,
+ .crop_end_x = 2271,
+ .hts = 2816,
+
+ /* Vertical */
+ .crop_start_y = 438,
+ .offset_y = 0,
+ .output_size_y = 1080,
+ .crop_end_y = 1517,
+ .vts = 1984,
+
+ /* Subsample increase */
+ .inc_x_odd = 1,
+ .inc_x_even = 1,
+ .inc_y_odd = 1,
+ .inc_y_even = 1,
+
+ /* Frame Interval */
+ .frame_interval = {
+ { 1, 15 },
+ { 1, 15 },
+ },
+
+ /* PLL */
+ .pll1_config = {
+ &ov5648_pll1_config_native_8_bits,
+ &ov5648_pll1_config_native_10_bits,
+ },
+ .pll2_config = &ov5648_pll2_config_native,
+ },
+ /* 1280x960 */
+ {
+ /* Horizontal */
+ .crop_start_x = 16,
+ .offset_x = 8,
+ .output_size_x = 1280,
+ .crop_end_x = 2607,
+ .hts = 1912,
+
+ /* Vertical */
+ .crop_start_y = 6,
+ .offset_y = 6,
+ .output_size_y = 960,
+ .crop_end_y = 1949,
+ .vts = 1496,
+
+ /* Binning */
+ .binning_x = true,
+
+ /* Subsample increase */
+ .inc_x_odd = 3,
+ .inc_x_even = 1,
+ .inc_y_odd = 3,
+ .inc_y_even = 1,
+
+ /* Frame Interval */
+ .frame_interval = {
+ { 1, 30 },
+ { 1, 30 },
+ },
+
+ /* PLL */
+ .pll1_config = {
+ &ov5648_pll1_config_native_8_bits,
+ &ov5648_pll1_config_native_10_bits,
+ },
+ .pll2_config = &ov5648_pll2_config_native,
+ },
+ /* 1280x720 (HD) */
+ {
+ /* Horizontal */
+ .crop_start_x = 16,
+ .offset_x = 8,
+ .output_size_x = 1280,
+ .crop_end_x = 2607,
+ .hts = 1912,
+
+ /* Vertical */
+ .crop_start_y = 254,
+ .offset_y = 2,
+ .output_size_y = 720,
+ .crop_end_y = 1701,
+ .vts = 1496,
+
+ /* Binning */
+ .binning_x = true,
+
+ /* Subsample increase */
+ .inc_x_odd = 3,
+ .inc_x_even = 1,
+ .inc_y_odd = 3,
+ .inc_y_even = 1,
+
+ /* Frame Interval */
+ .frame_interval = {
+ { 1, 30 },
+ { 1, 30 },
+ },
+
+ /* PLL */
+ .pll1_config = {
+ &ov5648_pll1_config_native_8_bits,
+ &ov5648_pll1_config_native_10_bits,
+ },
+ .pll2_config = &ov5648_pll2_config_native,
+ },
+ /* 640x480 (VGA) */
+ {
+ /* Horizontal */
+ .crop_start_x = 0,
+ .offset_x = 8,
+ .output_size_x = 640,
+ .crop_end_x = 2623,
+ .hts = 1896,
+
+ /* Vertical */
+ .crop_start_y = 0,
+ .offset_y = 2,
+ .output_size_y = 480,
+ .crop_end_y = 1953,
+ .vts = 984,
+
+ /* Binning */
+ .binning_x = true,
+
+ /* Subsample increase */
+ .inc_x_odd = 7,
+ .inc_x_even = 1,
+ .inc_y_odd = 7,
+ .inc_y_even = 1,
+
+ /* Frame Interval */
+ .frame_interval = {
+ { 1, 30 },
+ { 1, 30 },
+ },
+
+ /* PLL */
+ .pll1_config = {
+ &ov5648_pll1_config_native_8_bits,
+ &ov5648_pll1_config_native_10_bits,
+ },
+ .pll2_config = &ov5648_pll2_config_native,
+ },
+};
+
+static const u32 ov5648_mbus_codes[] = {
+ MEDIA_BUS_FMT_SBGGR8_1X8,
+ MEDIA_BUS_FMT_SBGGR10_1X10,
+};
+
+static const struct ov5648_register_value ov5648_init_sequence[] = {
+ /* PSRAM */
+ { OV5648_PSRAM_CTRL1_REG, 0x0d },
+ { OV5648_PSRAM_CTRLF_REG, 0xf5 },
+};
+
+static const s64 ov5648_link_freq_menu[] = {
+ 210000000,
+ 168000000,
+};
+
+static const char *const ov5648_test_pattern_menu[] = {
+ "Disabled",
+ "Random data",
+ "Color bars",
+ "Color bars with rolling bar",
+ "Color squares",
+ "Color squares with rolling bar"
+};
+
+static const u8 ov5648_test_pattern_bits[] = {
+ 0,
+ OV5648_ISP_CTRL3D_PATTERN_EN | OV5648_ISP_CTRL3D_PATTERN_RANDOM_DATA,
+ OV5648_ISP_CTRL3D_PATTERN_EN | OV5648_ISP_CTRL3D_PATTERN_COLOR_BARS,
+ OV5648_ISP_CTRL3D_PATTERN_EN | OV5648_ISP_CTRL3D_ROLLING_BAR_EN |
+ OV5648_ISP_CTRL3D_PATTERN_COLOR_BARS,
+ OV5648_ISP_CTRL3D_PATTERN_EN | OV5648_ISP_CTRL3D_PATTERN_COLOR_SQUARES,
+ OV5648_ISP_CTRL3D_PATTERN_EN | OV5648_ISP_CTRL3D_ROLLING_BAR_EN |
+ OV5648_ISP_CTRL3D_PATTERN_COLOR_SQUARES,
+};
+
+/* Input/Output */
+
+static int ov5648_read(struct ov5648_sensor *sensor, u16 address, u8 *value)
+{
+ unsigned char data[2] = { address >> 8, address & 0xff };
+ struct i2c_client *client = sensor->i2c_client;
+ int ret;
+
+ ret = i2c_master_send(client, data, sizeof(data));
+ if (ret < 0) {
+ dev_dbg(&client->dev, "i2c send error at address %#04x\n",
+ address);
+ return ret;
+ }
+
+ ret = i2c_master_recv(client, value, 1);
+ if (ret < 0) {
+ dev_dbg(&client->dev, "i2c recv error at address %#04x\n",
+ address);
+ return ret;
+ }
+
+ return 0;
+}
+
+static int ov5648_write(struct ov5648_sensor *sensor, u16 address, u8 value)
+{
+ unsigned char data[3] = { address >> 8, address & 0xff, value };
+ struct i2c_client *client = sensor->i2c_client;
+ int ret;
+
+ ret = i2c_master_send(client, data, sizeof(data));
+ if (ret < 0) {
+ dev_dbg(&client->dev, "i2c send error at address %#04x\n",
+ address);
+ return ret;
+ }
+
+ return 0;
+}
+
+static int ov5648_write_sequence(struct ov5648_sensor *sensor,
+ const struct ov5648_register_value *sequence,
+ unsigned int sequence_count)
+{
+ unsigned int i;
+ int ret = 0;
+
+ for (i = 0; i < sequence_count; i++) {
+ ret = ov5648_write(sensor, sequence[i].address,
+ sequence[i].value);
+ if (ret)
+ break;
+
+ if (sequence[i].delay_ms)
+ msleep(sequence[i].delay_ms);
+ }
+
+ return ret;
+}
+
+static int ov5648_update_bits(struct ov5648_sensor *sensor, u16 address,
+ u8 mask, u8 bits)
+{
+ u8 value = 0;
+ int ret;
+
+ ret = ov5648_read(sensor, address, &value);
+ if (ret)
+ return ret;
+
+ value &= ~mask;
+ value |= bits;
+
+ ret = ov5648_write(sensor, address, value);
+ if (ret)
+ return ret;
+
+ return 0;
+}
+
+/* Sensor */
+
+static int ov5648_sw_reset(struct ov5648_sensor *sensor)
+{
+ int ret;
+
+ ret = ov5648_write(sensor, OV5648_SW_RESET_REG, OV5648_SW_RESET_RESET);
+ if (ret < 0)
+ return ret;
+
+ return 0;
+}
+
+static int ov5648_sw_standby(struct ov5648_sensor *sensor, int standby)
+{
+ u8 value = 0;
+ int ret;
+
+ if (!standby)
+ value = OV5648_SW_STANDBY_STREAM_ON;
+
+ ret = ov5648_write(sensor, OV5648_SW_STANDBY_REG, value);
+ if (ret < 0)
+ return ret;
+
+ return 0;
+}
+
+static int ov5648_chip_id_check(struct ov5648_sensor *sensor)
+{
+ u16 regs[] = { OV5648_CHIP_ID_H_REG, OV5648_CHIP_ID_L_REG };
+ u8 values[] = { OV5648_CHIP_ID_H_VALUE, OV5648_CHIP_ID_L_VALUE };
+ unsigned int i;
+ u8 value;
+ int ret;
+
+ for (i = 0; i < ARRAY_SIZE(regs); i++) {
+ ret = ov5648_read(sensor, regs[i], &value);
+ if (ret < 0)
+ return ret;
+
+ if (value != values[i]) {
+ dev_err(sensor->dev,
+ "chip id value mismatch: %#x instead of %#x\n",
+ value, values[i]);
+ return -EINVAL;
+ }
+ }
+
+ return 0;
+}
+
+static int ov5648_avdd_internal_power(struct ov5648_sensor *sensor, int on)
+{
+ return ov5648_write(sensor, OV5648_A_PWC_PK_O0_REG,
+ on ? 0 : OV5648_A_PWC_PK_O0_BP_REGULATOR_N);
+}
+
+static int ov5648_pad_configure(struct ov5648_sensor *sensor)
+{
+ int ret;
+
+ /* Configure pads as input. */
+
+ ret = ov5648_write(sensor, OV5648_PAD_OEN1_REG, 0);
+ if (ret)
+ return ret;
+
+ ret = ov5648_write(sensor, OV5648_PAD_OEN2_REG, 0);
+ if (ret)
+ return ret;
+
+ /* Disable FREX pin. */
+
+ return ov5648_write(sensor, OV5648_PAD_PK_REG,
+ OV5648_PAD_PK_DRIVE_STRENGTH_1X |
+ OV5648_PAD_PK_FREX_N);
+}
+
+static int ov5648_mipi_configure(struct ov5648_sensor *sensor)
+{
+ struct v4l2_fwnode_bus_mipi_csi2 *bus_mipi_csi2 =
+ &sensor->endpoint.bus.mipi_csi2;
+ unsigned int lanes_count = bus_mipi_csi2->num_data_lanes;
+ int ret;
+
+ ret = ov5648_write(sensor, OV5648_MIPI_CTRL0_REG,
+ OV5648_MIPI_CTRL0_CLK_LANE_AUTOGATE |
+ OV5648_MIPI_CTRL0_LANE_SELECT_LANE1 |
+ OV5648_MIPI_CTRL0_IDLE_LP11);
+ if (ret)
+ return ret;
+
+ return ov5648_write(sensor, OV5648_MIPI_SC_CTRL0_REG,
+ OV5648_MIPI_SC_CTRL0_MIPI_LANES(lanes_count) |
+ OV5648_MIPI_SC_CTRL0_PHY_LP_RX_PD |
+ OV5648_MIPI_SC_CTRL0_MIPI_EN);
+}
+
+static int ov5648_black_level_configure(struct ov5648_sensor *sensor)
+{
+ int ret;
+
+ /* Up to 6 lines are available for black level calibration. */
+
+ ret = ov5648_write(sensor, OV5648_BLC_CTRL1_REG,
+ OV5648_BLC_CTRL1_START_LINE(2));
+ if (ret)
+ return ret;
+
+ ret = ov5648_write(sensor, OV5648_BLC_CTRL2_REG,
+ OV5648_BLC_CTRL2_AUTO_EN |
+ OV5648_BLC_CTRL2_RESET_FRAME_NUM(5));
+ if (ret)
+ return ret;
+
+ ret = ov5648_write(sensor, OV5648_BLC_LINE_NUM_REG,
+ OV5648_BLC_LINE_NUM(4));
+ if (ret)
+ return ret;
+
+ return ov5648_update_bits(sensor, OV5648_BLC_CTRL5_REG,
+ OV5648_BLC_CTRL5_UPDATE_EN,
+ OV5648_BLC_CTRL5_UPDATE_EN);
+}
+
+static int ov5648_isp_configure(struct ov5648_sensor *sensor)
+{
+ u8 bits;
+ int ret;
+
+ /* Enable black and white level correction. */
+ bits = OV5648_ISP_CTRL0_BLACK_CORRECT_EN |
+ OV5648_ISP_CTRL0_WHITE_CORRECT_EN;
+
+ ret = ov5648_update_bits(sensor, OV5648_ISP_CTRL0_REG, bits, bits);
+ if (ret)
+ return ret;
+
+ /* Enable AWB. */
+ ret = ov5648_write(sensor, OV5648_ISP_CTRL1_REG,
+ OV5648_ISP_CTRL1_AWB_EN);
+ if (ret)
+ return ret;
+
+ /* Enable AWB gain and windowing. */
+ ret = ov5648_write(sensor, OV5648_ISP_CTRL2_REG,
+ OV5648_ISP_CTRL2_WIN_EN |
+ OV5648_ISP_CTRL2_AWB_GAIN_EN);
+ if (ret)
+ return ret;
+
+ /* Enable buffering and auto-binning. */
+ ret = ov5648_write(sensor, OV5648_ISP_CTRL3_REG,
+ OV5648_ISP_CTRL3_BUF_EN |
+ OV5648_ISP_CTRL3_BIN_AUTO_EN);
+ if (ret)
+ return ret;
+
+ ret = ov5648_write(sensor, OV5648_ISP_CTRL4_REG, 0);
+ if (ret)
+ return ret;
+
+ ret = ov5648_write(sensor, OV5648_ISP_CTRL1F_REG,
+ OV5648_ISP_CTRL1F_OUTPUT_EN);
+ if (ret)
+ return ret;
+
+ /* Enable post-binning filters. */
+ ret = ov5648_write(sensor, OV5648_ISP_CTRL4B_REG,
+ OV5648_ISP_CTRL4B_POST_BIN_H_EN |
+ OV5648_ISP_CTRL4B_POST_BIN_V_EN);
+ if (ret)
+ return ret;
+
+ /* Disable debanding and night mode. Debug bit seems necessary. */
+ ret = ov5648_write(sensor, OV5648_AEC_CTRL0_REG,
+ OV5648_AEC_CTRL0_DEBUG |
+ OV5648_AEC_CTRL0_START_SEL_EN);
+ if (ret)
+ return ret;
+
+ return ov5648_write(sensor, OV5648_MANUAL_CTRL_REG,
+ OV5648_MANUAL_CTRL_FRAME_DELAY(1));
+}
+
+static unsigned long ov5648_mode_pll1_rate(struct ov5648_sensor *sensor,
+ const struct ov5648_pll1_config *config)
+{
+ unsigned long xvclk_rate;
+ unsigned long pll1_rate;
+
+ xvclk_rate = clk_get_rate(sensor->xvclk);
+ pll1_rate = xvclk_rate * config->pll_mul;
+
+ switch (config->pll_pre_div) {
+ case 5:
+ pll1_rate *= 3;
+ pll1_rate /= 2;
+ break;
+ case 7:
+ pll1_rate *= 5;
+ pll1_rate /= 2;
+ break;
+ default:
+ pll1_rate /= config->pll_pre_div;
+ break;
+ }
+
+ return pll1_rate;
+}
+
+static int ov5648_mode_pll1_configure(struct ov5648_sensor *sensor,
+ const struct ov5648_mode *mode,
+ u32 mbus_code)
+{
+ const struct ov5648_pll1_config *config;
+ u8 value;
+ int ret;
+
+ value = OV5648_PLL_CTRL0_PLL_CHARGE_PUMP(1);
+
+ switch (mbus_code) {
+ case MEDIA_BUS_FMT_SBGGR8_1X8:
+ config = mode->pll1_config[0];
+ value |= OV5648_PLL_CTRL0_BITS(8);
+ break;
+ case MEDIA_BUS_FMT_SBGGR10_1X10:
+ config = mode->pll1_config[1];
+ value |= OV5648_PLL_CTRL0_BITS(10);
+ break;
+ default:
+ return -EINVAL;
+ }
+
+ ret = ov5648_write(sensor, OV5648_PLL_CTRL0_REG, value);
+ if (ret)
+ return ret;
+
+ ret = ov5648_write(sensor, OV5648_PLL_DIV_REG,
+ OV5648_PLL_DIV_ROOT_DIV(config->root_div) |
+ OV5648_PLL_DIV_PLL_PRE_DIV(config->pll_pre_div));
+ if (ret)
+ return ret;
+
+ ret = ov5648_write(sensor, OV5648_PLL_MUL_REG,
+ OV5648_PLL_MUL(config->pll_mul));
+ if (ret)
+ return ret;
+
+ ret = ov5648_write(sensor, OV5648_PLL_CTRL1_REG,
+ OV5648_PLL_CTRL1_SYS_DIV(config->sys_div) |
+ OV5648_PLL_CTRL1_MIPI_DIV(config->mipi_div));
+ if (ret)
+ return ret;
+
+ return ov5648_write(sensor, OV5648_SRB_CTRL_REG,
+ OV5648_SRB_CTRL_SCLK_DIV(config->sclk_div) |
+ OV5648_SRB_CTRL_SCLK_ARBITER_EN);
+}
+
+static int ov5648_mode_pll2_configure(struct ov5648_sensor *sensor,
+ const struct ov5648_mode *mode)
+{
+ const struct ov5648_pll2_config *config = mode->pll2_config;
+ int ret;
+
+ ret = ov5648_write(sensor, OV5648_PLLS_DIV_REG,
+ OV5648_PLLS_DIV_PLLS_PRE_DIV(config->plls_pre_div) |
+ OV5648_PLLS_DIV_PLLS_DIV_R(config->plls_div_r) |
+ OV5648_PLLS_DIV_PLLS_SEL_DIV(config->sel_div));
+ if (ret)
+ return ret;
+
+ ret = ov5648_write(sensor, OV5648_PLLS_MUL_REG,
+ OV5648_PLLS_MUL(config->plls_mul));
+ if (ret)
+ return ret;
+
+ return ov5648_write(sensor, OV5648_PLLS_CTRL_REG,
+ OV5648_PLLS_CTRL_PLL_CHARGE_PUMP(1) |
+ OV5648_PLLS_CTRL_SYS_DIV(config->sys_div));
+}
+
+static int ov5648_mode_configure(struct ov5648_sensor *sensor,
+ const struct ov5648_mode *mode, u32 mbus_code)
+{
+ int ret;
+
+ /* Crop Start X */
+
+ ret = ov5648_write(sensor, OV5648_CROP_START_X_H_REG,
+ OV5648_CROP_START_X_H(mode->crop_start_x));
+ if (ret)
+ return ret;
+
+ ret = ov5648_write(sensor, OV5648_CROP_START_X_L_REG,
+ OV5648_CROP_START_X_L(mode->crop_start_x));
+ if (ret)
+ return ret;
+
+ /* Offset X */
+
+ ret = ov5648_write(sensor, OV5648_OFFSET_X_H_REG,
+ OV5648_OFFSET_X_H(mode->offset_x));
+ if (ret)
+ return ret;
+
+ ret = ov5648_write(sensor, OV5648_OFFSET_X_L_REG,
+ OV5648_OFFSET_X_L(mode->offset_x));
+ if (ret)
+ return ret;
+
+ /* Output Size X */
+
+ ret = ov5648_write(sensor, OV5648_OUTPUT_SIZE_X_H_REG,
+ OV5648_OUTPUT_SIZE_X_H(mode->output_size_x));
+ if (ret)
+ return ret;
+
+ ret = ov5648_write(sensor, OV5648_OUTPUT_SIZE_X_L_REG,
+ OV5648_OUTPUT_SIZE_X_L(mode->output_size_x));
+ if (ret)
+ return ret;
+
+ /* Crop End X */
+
+ ret = ov5648_write(sensor, OV5648_CROP_END_X_H_REG,
+ OV5648_CROP_END_X_H(mode->crop_end_x));
+ if (ret)
+ return ret;
+
+ ret = ov5648_write(sensor, OV5648_CROP_END_X_L_REG,
+ OV5648_CROP_END_X_L(mode->crop_end_x));
+ if (ret)
+ return ret;
+
+ /* Horizontal Total Size */
+
+ ret = ov5648_write(sensor, OV5648_HTS_H_REG, OV5648_HTS_H(mode->hts));
+ if (ret)
+ return ret;
+
+ ret = ov5648_write(sensor, OV5648_HTS_L_REG, OV5648_HTS_L(mode->hts));
+ if (ret)
+ return ret;
+
+ /* Crop Start Y */
+
+ ret = ov5648_write(sensor, OV5648_CROP_START_Y_H_REG,
+ OV5648_CROP_START_Y_H(mode->crop_start_y));
+ if (ret)
+ return ret;
+
+ ret = ov5648_write(sensor, OV5648_CROP_START_Y_L_REG,
+ OV5648_CROP_START_Y_L(mode->crop_start_y));
+ if (ret)
+ return ret;
+
+ /* Offset Y */
+
+ ret = ov5648_write(sensor, OV5648_OFFSET_Y_H_REG,
+ OV5648_OFFSET_Y_H(mode->offset_y));
+ if (ret)
+ return ret;
+
+ ret = ov5648_write(sensor, OV5648_OFFSET_Y_L_REG,
+ OV5648_OFFSET_Y_L(mode->offset_y));
+ if (ret)
+ return ret;
+
+ /* Output Size Y */
+
+ ret = ov5648_write(sensor, OV5648_OUTPUT_SIZE_Y_H_REG,
+ OV5648_OUTPUT_SIZE_Y_H(mode->output_size_y));
+ if (ret)
+ return ret;
+
+ ret = ov5648_write(sensor, OV5648_OUTPUT_SIZE_Y_L_REG,
+ OV5648_OUTPUT_SIZE_Y_L(mode->output_size_y));
+ if (ret)
+ return ret;
+
+ /* Crop End Y */
+
+ ret = ov5648_write(sensor, OV5648_CROP_END_Y_H_REG,
+ OV5648_CROP_END_Y_H(mode->crop_end_y));
+ if (ret)
+ return ret;
+
+ ret = ov5648_write(sensor, OV5648_CROP_END_Y_L_REG,
+ OV5648_CROP_END_Y_L(mode->crop_end_y));
+ if (ret)
+ return ret;
+
+ /* Vertical Total Size */
+
+ ret = ov5648_write(sensor, OV5648_VTS_H_REG, OV5648_VTS_H(mode->vts));
+ if (ret)
+ return ret;
+
+ ret = ov5648_write(sensor, OV5648_VTS_L_REG, OV5648_VTS_L(mode->vts));
+ if (ret)
+ return ret;
+
+ /* Flip/Mirror/Binning */
+
+ /*
+ * A debug bit is enabled by default and needs to be cleared for
+ * subsampling to work.
+ */
+ ret = ov5648_update_bits(sensor, OV5648_TC20_REG,
+ OV5648_TC20_DEBUG |
+ OV5648_TC20_BINNING_VERT_EN,
+ mode->binning_y ? OV5648_TC20_BINNING_VERT_EN :
+ 0);
+ if (ret)
+ return ret;
+
+ ret = ov5648_update_bits(sensor, OV5648_TC21_REG,
+ OV5648_TC21_BINNING_HORZ_EN,
+ mode->binning_x ? OV5648_TC21_BINNING_HORZ_EN :
+ 0);
+ if (ret)
+ return ret;
+
+ ret = ov5648_write(sensor, OV5648_SUB_INC_X_REG,
+ OV5648_SUB_INC_X_ODD(mode->inc_x_odd) |
+ OV5648_SUB_INC_X_EVEN(mode->inc_x_even));
+ if (ret)
+ return ret;
+
+ ret = ov5648_write(sensor, OV5648_SUB_INC_Y_REG,
+ OV5648_SUB_INC_Y_ODD(mode->inc_y_odd) |
+ OV5648_SUB_INC_Y_EVEN(mode->inc_y_even));
+ if (ret)
+ return ret;
+
+ /* PLLs */
+
+ ret = ov5648_mode_pll1_configure(sensor, mode, mbus_code);
+ if (ret)
+ return ret;
+
+ ret = ov5648_mode_pll2_configure(sensor, mode);
+ if (ret)
+ return ret;
+
+ /* Extra registers */
+
+ if (mode->register_values) {
+ ret = ov5648_write_sequence(sensor, mode->register_values,
+ mode->register_values_count);
+ if (ret)
+ return ret;
+ }
+
+ return 0;
+}
+
+static unsigned long ov5648_mode_mipi_clk_rate(struct ov5648_sensor *sensor,
+ const struct ov5648_mode *mode,
+ u32 mbus_code)
+{
+ const struct ov5648_pll1_config *config;
+ unsigned long pll1_rate;
+
+ switch (mbus_code) {
+ case MEDIA_BUS_FMT_SBGGR8_1X8:
+ config = mode->pll1_config[0];
+ break;
+ case MEDIA_BUS_FMT_SBGGR10_1X10:
+ config = mode->pll1_config[1];
+ break;
+ default:
+ return 0;
+ }
+
+ pll1_rate = ov5648_mode_pll1_rate(sensor, config);
+
+ return pll1_rate / config->sys_div / config->mipi_div / 2;
+}
+
+/* Exposure */
+
+static int ov5648_exposure_auto_configure(struct ov5648_sensor *sensor,
+ bool enable)
+{
+ return ov5648_update_bits(sensor, OV5648_MANUAL_CTRL_REG,
+ OV5648_MANUAL_CTRL_AEC_MANUAL_EN,
+ enable ? 0 : OV5648_MANUAL_CTRL_AEC_MANUAL_EN);
+}
+
+static int ov5648_exposure_configure(struct ov5648_sensor *sensor, u32 exposure)
+{
+ struct ov5648_ctrls *ctrls = &sensor->ctrls;
+ int ret;
+
+ if (ctrls->exposure_auto->val != V4L2_EXPOSURE_MANUAL)
+ return -EINVAL;
+
+ ret = ov5648_write(sensor, OV5648_EXPOSURE_CTRL_HH_REG,
+ OV5648_EXPOSURE_CTRL_HH(exposure));
+ if (ret)
+ return ret;
+
+ ret = ov5648_write(sensor, OV5648_EXPOSURE_CTRL_H_REG,
+ OV5648_EXPOSURE_CTRL_H(exposure));
+ if (ret)
+ return ret;
+
+ return ov5648_write(sensor, OV5648_EXPOSURE_CTRL_L_REG,
+ OV5648_EXPOSURE_CTRL_L(exposure));
+}
+
+static int ov5648_exposure_value(struct ov5648_sensor *sensor,
+ u32 *exposure)
+{
+ u8 exposure_hh = 0, exposure_h = 0, exposure_l = 0;
+ int ret;
+
+ ret = ov5648_read(sensor, OV5648_EXPOSURE_CTRL_HH_REG, &exposure_hh);
+ if (ret)
+ return ret;
+
+ ret = ov5648_read(sensor, OV5648_EXPOSURE_CTRL_H_REG, &exposure_h);
+ if (ret)
+ return ret;
+
+ ret = ov5648_read(sensor, OV5648_EXPOSURE_CTRL_L_REG, &exposure_l);
+ if (ret)
+ return ret;
+
+ *exposure = OV5648_EXPOSURE_CTRL_HH_VALUE((u32)exposure_hh) |
+ OV5648_EXPOSURE_CTRL_H_VALUE((u32)exposure_h) |
+ OV5648_EXPOSURE_CTRL_L_VALUE((u32)exposure_l);
+
+ return 0;
+}
+
+/* Gain */
+
+static int ov5648_gain_auto_configure(struct ov5648_sensor *sensor, bool enable)
+{
+ return ov5648_update_bits(sensor, OV5648_MANUAL_CTRL_REG,
+ OV5648_MANUAL_CTRL_AGC_MANUAL_EN,
+ enable ? 0 : OV5648_MANUAL_CTRL_AGC_MANUAL_EN);
+}
+
+static int ov5648_gain_configure(struct ov5648_sensor *sensor, u32 gain)
+{
+ struct ov5648_ctrls *ctrls = &sensor->ctrls;
+ int ret;
+
+ if (ctrls->gain_auto->val)
+ return -EINVAL;
+
+ ret = ov5648_write(sensor, OV5648_GAIN_CTRL_H_REG,
+ OV5648_GAIN_CTRL_H(gain));
+ if (ret)
+ return ret;
+
+ return ov5648_write(sensor, OV5648_GAIN_CTRL_L_REG,
+ OV5648_GAIN_CTRL_L(gain));
+}
+
+static int ov5648_gain_value(struct ov5648_sensor *sensor, u32 *gain)
+{
+ u8 gain_h = 0, gain_l = 0;
+ int ret;
+
+ ret = ov5648_read(sensor, OV5648_GAIN_CTRL_H_REG, &gain_h);
+ if (ret)
+ return ret;
+
+ ret = ov5648_read(sensor, OV5648_GAIN_CTRL_L_REG, &gain_l);
+ if (ret)
+ return ret;
+
+ *gain = OV5648_GAIN_CTRL_H_VALUE((u32)gain_h) |
+ OV5648_GAIN_CTRL_L_VALUE((u32)gain_l);
+
+ return 0;
+}
+
+/* White Balance */
+
+static int ov5648_white_balance_auto_configure(struct ov5648_sensor *sensor,
+ bool enable)
+{
+ return ov5648_write(sensor, OV5648_AWB_CTRL_REG,
+ enable ? 0 : OV5648_AWB_CTRL_GAIN_MANUAL_EN);
+}
+
+static int ov5648_white_balance_configure(struct ov5648_sensor *sensor,
+ u32 red_balance, u32 blue_balance)
+{
+ struct ov5648_ctrls *ctrls = &sensor->ctrls;
+ int ret;
+
+ if (ctrls->white_balance_auto->val)
+ return -EINVAL;
+
+ ret = ov5648_write(sensor, OV5648_GAIN_RED_MAN_H_REG,
+ OV5648_GAIN_RED_MAN_H(red_balance));
+ if (ret)
+ return ret;
+
+ ret = ov5648_write(sensor, OV5648_GAIN_RED_MAN_L_REG,
+ OV5648_GAIN_RED_MAN_L(red_balance));
+ if (ret)
+ return ret;
+
+ ret = ov5648_write(sensor, OV5648_GAIN_BLUE_MAN_H_REG,
+ OV5648_GAIN_BLUE_MAN_H(blue_balance));
+ if (ret)
+ return ret;
+
+ return ov5648_write(sensor, OV5648_GAIN_BLUE_MAN_L_REG,
+ OV5648_GAIN_BLUE_MAN_L(blue_balance));
+}
+
+/* Flip */
+
+static int ov5648_flip_vert_configure(struct ov5648_sensor *sensor, bool enable)
+{
+ u8 bits = OV5648_TC20_FLIP_VERT_ISP_EN |
+ OV5648_TC20_FLIP_VERT_SENSOR_EN;
+
+ return ov5648_update_bits(sensor, OV5648_TC20_REG, bits,
+ enable ? bits : 0);
+}
+
+static int ov5648_flip_horz_configure(struct ov5648_sensor *sensor, bool enable)
+{
+ u8 bits = OV5648_TC21_FLIP_HORZ_ISP_EN |
+ OV5648_TC21_FLIP_HORZ_SENSOR_EN;
+
+ return ov5648_update_bits(sensor, OV5648_TC21_REG, bits,
+ enable ? bits : 0);
+}
+
+/* Test Pattern */
+
+static int ov5648_test_pattern_configure(struct ov5648_sensor *sensor,
+ unsigned int index)
+{
+ if (index >= ARRAY_SIZE(ov5648_test_pattern_bits))
+ return -EINVAL;
+
+ return ov5648_write(sensor, OV5648_ISP_CTRL3D_REG,
+ ov5648_test_pattern_bits[index]);
+}
+
+/* State */
+
+static int ov5648_state_mipi_configure(struct ov5648_sensor *sensor,
+ const struct ov5648_mode *mode,
+ u32 mbus_code)
+{
+ struct ov5648_ctrls *ctrls = &sensor->ctrls;
+ struct v4l2_fwnode_bus_mipi_csi2 *bus_mipi_csi2 =
+ &sensor->endpoint.bus.mipi_csi2;
+ unsigned long mipi_clk_rate;
+ unsigned int bits_per_sample;
+ unsigned int lanes_count;
+ unsigned int i, j;
+ s64 mipi_pixel_rate;
+
+ mipi_clk_rate = ov5648_mode_mipi_clk_rate(sensor, mode, mbus_code);
+ if (!mipi_clk_rate)
+ return -EINVAL;
+
+ for (i = 0; i < ARRAY_SIZE(ov5648_link_freq_menu); i++) {
+ s64 freq = ov5648_link_freq_menu[i];
+
+ if (freq == mipi_clk_rate)
+ break;
+ }
+
+ for (j = 0; j < sensor->endpoint.nr_of_link_frequencies; j++) {
+ u64 freq = sensor->endpoint.link_frequencies[j];
+
+ if (freq == mipi_clk_rate)
+ break;
+ }
+
+ if (i == ARRAY_SIZE(ov5648_link_freq_menu)) {
+ dev_err(sensor->dev,
+ "failed to find %lu clk rate in link freq\n",
+ mipi_clk_rate);
+ } else if (j == sensor->endpoint.nr_of_link_frequencies) {
+ dev_err(sensor->dev,
+ "failed to find %lu clk rate in endpoint link-frequencies\n",
+ mipi_clk_rate);
+ } else {
+ __v4l2_ctrl_s_ctrl(ctrls->link_freq, i);
+ }
+
+ switch (mbus_code) {
+ case MEDIA_BUS_FMT_SBGGR8_1X8:
+ bits_per_sample = 8;
+ break;
+ case MEDIA_BUS_FMT_SBGGR10_1X10:
+ bits_per_sample = 10;
+ break;
+ default:
+ return -EINVAL;
+ }
+
+ lanes_count = bus_mipi_csi2->num_data_lanes;
+ mipi_pixel_rate = mipi_clk_rate * 2 * lanes_count / bits_per_sample;
+
+ __v4l2_ctrl_s_ctrl_int64(ctrls->pixel_rate, mipi_pixel_rate);
+
+ return 0;
+}
+
+static int ov5648_state_configure(struct ov5648_sensor *sensor,
+ const struct ov5648_mode *mode,
+ u32 mbus_code)
+{
+ int ret;
+
+ if (sensor->state.streaming)
+ return -EBUSY;
+
+ /* State will be configured at first power on otherwise. */
+ if (pm_runtime_enabled(sensor->dev) &&
+ !pm_runtime_suspended(sensor->dev)) {
+ ret = ov5648_mode_configure(sensor, mode, mbus_code);
+ if (ret)
+ return ret;
+ }
+
+ ret = ov5648_state_mipi_configure(sensor, mode, mbus_code);
+ if (ret)
+ return ret;
+
+ sensor->state.mode = mode;
+ sensor->state.mbus_code = mbus_code;
+
+ return 0;
+}
+
+static int ov5648_state_init(struct ov5648_sensor *sensor)
+{
+ return ov5648_state_configure(sensor, &ov5648_modes[0],
+ ov5648_mbus_codes[0]);
+}
+
+/* Sensor Base */
+
+static int ov5648_sensor_init(struct ov5648_sensor *sensor)
+{
+ int ret;
+
+ ret = ov5648_sw_reset(sensor);
+ if (ret) {
+ dev_err(sensor->dev, "failed to perform sw reset\n");
+ return ret;
+ }
+
+ ret = ov5648_sw_standby(sensor, 1);
+ if (ret) {
+ dev_err(sensor->dev, "failed to set sensor standby\n");
+ return ret;
+ }
+
+ ret = ov5648_chip_id_check(sensor);
+ if (ret) {
+ dev_err(sensor->dev, "failed to check sensor chip id\n");
+ return ret;
+ }
+
+ ret = ov5648_avdd_internal_power(sensor, !sensor->avdd);
+ if (ret) {
+ dev_err(sensor->dev, "failed to set internal avdd power\n");
+ return ret;
+ }
+
+ ret = ov5648_write_sequence(sensor, ov5648_init_sequence,
+ ARRAY_SIZE(ov5648_init_sequence));
+ if (ret) {
+ dev_err(sensor->dev, "failed to write init sequence\n");
+ return ret;
+ }
+
+ ret = ov5648_pad_configure(sensor);
+ if (ret) {
+ dev_err(sensor->dev, "failed to configure pad\n");
+ return ret;
+ }
+
+ ret = ov5648_mipi_configure(sensor);
+ if (ret) {
+ dev_err(sensor->dev, "failed to configure MIPI\n");
+ return ret;
+ }
+
+ ret = ov5648_isp_configure(sensor);
+ if (ret) {
+ dev_err(sensor->dev, "failed to configure ISP\n");
+ return ret;
+ }
+
+ ret = ov5648_black_level_configure(sensor);
+ if (ret) {
+ dev_err(sensor->dev, "failed to configure black level\n");
+ return ret;
+ }
+
+ /* Configure current mode. */
+ ret = ov5648_state_configure(sensor, sensor->state.mode,
+ sensor->state.mbus_code);
+ if (ret) {
+ dev_err(sensor->dev, "failed to configure state\n");
+ return ret;
+ }
+
+ return 0;
+}
+
+static int ov5648_sensor_power(struct ov5648_sensor *sensor, bool on)
+{
+ /* Keep initialized to zero for disable label. */
+ int ret = 0;
+
+ /*
+ * General notes about the power sequence:
+ * - power-down GPIO must be active (low) during power-on;
+ * - reset GPIO state does not matter during power-on;
+ * - XVCLK must be provided 1 ms before register access;
+ * - 10 ms are needed between power-down deassert and register access.
+ */
+
+ /* Note that regulator-and-GPIO-based power is untested. */
+ if (on) {
+ gpiod_set_value_cansleep(sensor->reset, 1);
+ gpiod_set_value_cansleep(sensor->powerdown, 1);
+
+ ret = regulator_enable(sensor->dovdd);
+ if (ret) {
+ dev_err(sensor->dev,
+ "failed to enable DOVDD regulator\n");
+ goto disable;
+ }
+
+ if (sensor->avdd) {
+ ret = regulator_enable(sensor->avdd);
+ if (ret) {
+ dev_err(sensor->dev,
+ "failed to enable AVDD regulator\n");
+ goto disable;
+ }
+ }
+
+ ret = regulator_enable(sensor->dvdd);
+ if (ret) {
+ dev_err(sensor->dev,
+ "failed to enable DVDD regulator\n");
+ goto disable;
+ }
+
+ /* According to OV5648 power up diagram. */
+ usleep_range(5000, 10000);
+
+ ret = clk_prepare_enable(sensor->xvclk);
+ if (ret) {
+ dev_err(sensor->dev, "failed to enable XVCLK clock\n");
+ goto disable;
+ }
+
+ gpiod_set_value_cansleep(sensor->reset, 0);
+ gpiod_set_value_cansleep(sensor->powerdown, 0);
+
+ usleep_range(20000, 25000);
+ } else {
+disable:
+ gpiod_set_value_cansleep(sensor->powerdown, 1);
+ gpiod_set_value_cansleep(sensor->reset, 1);
+
+ clk_disable_unprepare(sensor->xvclk);
+
+ regulator_disable(sensor->dvdd);
+
+ if (sensor->avdd)
+ regulator_disable(sensor->avdd);
+
+ regulator_disable(sensor->dovdd);
+ }
+
+ return ret;
+}
+
+/* Controls */
+
+static int ov5648_g_volatile_ctrl(struct v4l2_ctrl *ctrl)
+{
+ struct v4l2_subdev *subdev = ov5648_ctrl_subdev(ctrl);
+ struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
+ struct ov5648_ctrls *ctrls = &sensor->ctrls;
+ int ret;
+
+ switch (ctrl->id) {
+ case V4L2_CID_EXPOSURE_AUTO:
+ ret = ov5648_exposure_value(sensor, &ctrls->exposure->val);
+ if (ret)
+ return ret;
+ break;
+ case V4L2_CID_AUTOGAIN:
+ ret = ov5648_gain_value(sensor, &ctrls->gain->val);
+ if (ret)
+ return ret;
+ break;
+ default:
+ return -EINVAL;
+ }
+
+ return 0;
+}
+
+static int ov5648_s_ctrl(struct v4l2_ctrl *ctrl)
+{
+ struct v4l2_subdev *subdev = ov5648_ctrl_subdev(ctrl);
+ struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
+ struct ov5648_ctrls *ctrls = &sensor->ctrls;
+ unsigned int index;
+ bool enable;
+ int ret;
+
+ /* Wait for the sensor to be on before setting controls. */
+ if (pm_runtime_suspended(sensor->dev))
+ return 0;
+
+ switch (ctrl->id) {
+ case V4L2_CID_EXPOSURE_AUTO:
+ enable = ctrl->val == V4L2_EXPOSURE_AUTO;
+
+ ret = ov5648_exposure_auto_configure(sensor, enable);
+ if (ret)
+ return ret;
+
+ if (!enable && ctrls->exposure->is_new) {
+ ret = ov5648_exposure_configure(sensor,
+ ctrls->exposure->val);
+ if (ret)
+ return ret;
+ }
+ break;
+ case V4L2_CID_AUTOGAIN:
+ enable = !!ctrl->val;
+
+ ret = ov5648_gain_auto_configure(sensor, enable);
+ if (ret)
+ return ret;
+
+ if (!enable) {
+ ret = ov5648_gain_configure(sensor, ctrls->gain->val);
+ if (ret)
+ return ret;
+ }
+ break;
+ case V4L2_CID_AUTO_WHITE_BALANCE:
+ enable = !!ctrl->val;
+
+ ret = ov5648_white_balance_auto_configure(sensor, enable);
+ if (ret)
+ return ret;
+
+ if (!enable) {
+ ret = ov5648_white_balance_configure(sensor,
+ ctrls->red_balance->val,
+ ctrls->blue_balance->val);
+ if (ret)
+ return ret;
+ }
+ break;
+ case V4L2_CID_HFLIP:
+ enable = !!ctrl->val;
+ return ov5648_flip_horz_configure(sensor, enable);
+ case V4L2_CID_VFLIP:
+ enable = !!ctrl->val;
+ return ov5648_flip_vert_configure(sensor, enable);
+ case V4L2_CID_TEST_PATTERN:
+ index = (unsigned int)ctrl->val;
+ return ov5648_test_pattern_configure(sensor, index);
+ default:
+ return -EINVAL;
+ }
+
+ return 0;
+}
+
+static const struct v4l2_ctrl_ops ov5648_ctrl_ops = {
+ .g_volatile_ctrl = ov5648_g_volatile_ctrl,
+ .s_ctrl = ov5648_s_ctrl,
+};
+
+static int ov5648_ctrls_init(struct ov5648_sensor *sensor)
+{
+ struct ov5648_ctrls *ctrls = &sensor->ctrls;
+ struct v4l2_ctrl_handler *handler = &ctrls->handler;
+ const struct v4l2_ctrl_ops *ops = &ov5648_ctrl_ops;
+ int ret;
+
+ v4l2_ctrl_handler_init(handler, 32);
+
+ /* Use our mutex for ctrl locking. */
+ handler->lock = &sensor->mutex;
+
+ /* Exposure */
+
+ ctrls->exposure_auto = v4l2_ctrl_new_std_menu(handler, ops,
+ V4L2_CID_EXPOSURE_AUTO,
+ V4L2_EXPOSURE_MANUAL, 0,
+ V4L2_EXPOSURE_AUTO);
+
+ ctrls->exposure = v4l2_ctrl_new_std(handler, ops, V4L2_CID_EXPOSURE,
+ 16, 1048575, 16, 512);
+ ctrls->exposure->flags |= V4L2_CTRL_FLAG_VOLATILE;
+
+ v4l2_ctrl_auto_cluster(2, &ctrls->exposure_auto, 1, true);
+
+ /* Gain */
+
+ ctrls->gain_auto =
+ v4l2_ctrl_new_std(handler, ops, V4L2_CID_AUTOGAIN, 0, 1, 1, 1);
+
+ ctrls->gain = v4l2_ctrl_new_std(handler, ops, V4L2_CID_GAIN, 16, 1023,
+ 16, 16);
+ ctrls->gain->flags |= V4L2_CTRL_FLAG_VOLATILE;
+
+ v4l2_ctrl_auto_cluster(2, &ctrls->gain_auto, 0, true);
+
+ /* White Balance */
+
+ ctrls->white_balance_auto =
+ v4l2_ctrl_new_std(handler, ops, V4L2_CID_AUTO_WHITE_BALANCE, 0,
+ 1, 1, 1);
+
+ ctrls->red_balance = v4l2_ctrl_new_std(handler, ops,
+ V4L2_CID_RED_BALANCE, 0, 4095,
+ 1, 1024);
+
+ ctrls->blue_balance = v4l2_ctrl_new_std(handler, ops,
+ V4L2_CID_BLUE_BALANCE, 0, 4095,
+ 1, 1024);
+
+ v4l2_ctrl_auto_cluster(3, &ctrls->white_balance_auto, 0, false);
+
+ /* Flip */
+
+ v4l2_ctrl_new_std(handler, ops, V4L2_CID_HFLIP, 0, 1, 1, 0);
+ v4l2_ctrl_new_std(handler, ops, V4L2_CID_VFLIP, 0, 1, 1, 0);
+
+ /* Test Pattern */
+
+ v4l2_ctrl_new_std_menu_items(handler, ops, V4L2_CID_TEST_PATTERN,
+ ARRAY_SIZE(ov5648_test_pattern_menu) - 1,
+ 0, 0, ov5648_test_pattern_menu);
+
+ /* MIPI CSI-2 */
+
+ ctrls->link_freq =
+ v4l2_ctrl_new_int_menu(handler, NULL, V4L2_CID_LINK_FREQ,
+ ARRAY_SIZE(ov5648_link_freq_menu) - 1,
+ 0, ov5648_link_freq_menu);
+
+ ctrls->link_freq->flags |= V4L2_CTRL_FLAG_READ_ONLY;
+
+ ctrls->pixel_rate =
+ v4l2_ctrl_new_std(handler, NULL, V4L2_CID_PIXEL_RATE, 1,
+ INT_MAX, 1, 1);
+
+ ctrls->pixel_rate->flags |= V4L2_CTRL_FLAG_READ_ONLY;
+
+ if (handler->error) {
+ ret = handler->error;
+ goto error_ctrls;
+ }
+
+ sensor->subdev.ctrl_handler = handler;
+
+ return 0;
+
+error_ctrls:
+ v4l2_ctrl_handler_free(handler);
+
+ return ret;
+}
+
+/* Subdev Video Operations */
+
+static int ov5648_s_stream(struct v4l2_subdev *subdev, int enable)
+{
+ struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
+ struct ov5648_state *state = &sensor->state;
+ int ret = 0;
+
+ if (enable) {
+ ret = pm_runtime_get_sync(sensor->dev);
+ if (ret < 0) {
+ pm_runtime_put_noidle(sensor->dev);
+ return ret;
+ }
+ }
+
+ mutex_lock(&sensor->mutex);
+ ret = ov5648_sw_standby(sensor, !enable);
+ mutex_unlock(&sensor->mutex);
+
+ if (ret)
+ return ret;
+
+ state->streaming = !!enable;
+
+ if (!enable)
+ pm_runtime_put(sensor->dev);
+
+ return 0;
+}
+
+static int ov5648_g_frame_interval(struct v4l2_subdev *subdev,
+ struct v4l2_subdev_frame_interval *interval)
+{
+ struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
+ const struct ov5648_mode *mode;
+ int ret = 0;
+
+ mutex_lock(&sensor->mutex);
+
+ mode = sensor->state.mode;
+
+ switch (sensor->state.mbus_code) {
+ case MEDIA_BUS_FMT_SBGGR8_1X8:
+ interval->interval = mode->frame_interval[0];
+ break;
+ case MEDIA_BUS_FMT_SBGGR10_1X10:
+ interval->interval = mode->frame_interval[1];
+ break;
+ default:
+ ret = -EINVAL;
+ }
+
+ mutex_unlock(&sensor->mutex);
+
+ return ret;
+}
+
+static const struct v4l2_subdev_video_ops ov5648_subdev_video_ops = {
+ .s_stream = ov5648_s_stream,
+ .g_frame_interval = ov5648_g_frame_interval,
+ .s_frame_interval = ov5648_g_frame_interval,
+};
+
+/* Subdev Pad Operations */
+
+static int ov5648_enum_mbus_code(struct v4l2_subdev *subdev,
+ struct v4l2_subdev_pad_config *config,
+ struct v4l2_subdev_mbus_code_enum *code_enum)
+{
+ if (code_enum->index >= ARRAY_SIZE(ov5648_mbus_codes))
+ return -EINVAL;
+
+ code_enum->code = ov5648_mbus_codes[code_enum->index];
+
+ return 0;
+}
+
+static void ov5648_mbus_format_fill(struct v4l2_mbus_framefmt *mbus_format,
+ u32 mbus_code,
+ const struct ov5648_mode *mode)
+{
+ mbus_format->width = mode->output_size_x;
+ mbus_format->height = mode->output_size_y;
+ mbus_format->code = mbus_code;
+
+ mbus_format->field = V4L2_FIELD_NONE;
+ mbus_format->colorspace = V4L2_COLORSPACE_RAW;
+ mbus_format->ycbcr_enc =
+ V4L2_MAP_YCBCR_ENC_DEFAULT(mbus_format->colorspace);
+ mbus_format->quantization = V4L2_QUANTIZATION_FULL_RANGE;
+ mbus_format->xfer_func =
+ V4L2_MAP_XFER_FUNC_DEFAULT(mbus_format->colorspace);
+}
+
+static int ov5648_get_fmt(struct v4l2_subdev *subdev,
+ struct v4l2_subdev_pad_config *config,
+ struct v4l2_subdev_format *format)
+{
+ struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
+ struct v4l2_mbus_framefmt *mbus_format = &format->format;
+
+ mutex_lock(&sensor->mutex);
+
+ if (format->which == V4L2_SUBDEV_FORMAT_TRY)
+ *mbus_format = *v4l2_subdev_get_try_format(subdev, config,
+ format->pad);
+ else
+ ov5648_mbus_format_fill(mbus_format, sensor->state.mbus_code,
+ sensor->state.mode);
+
+ mutex_unlock(&sensor->mutex);
+
+ return 0;
+}
+
+static int ov5648_set_fmt(struct v4l2_subdev *subdev,
+ struct v4l2_subdev_pad_config *config,
+ struct v4l2_subdev_format *format)
+{
+ struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
+ struct v4l2_mbus_framefmt *mbus_format = &format->format;
+ const struct ov5648_mode *mode;
+ u32 mbus_code = 0;
+ unsigned int index;
+ int ret = 0;
+
+ mutex_lock(&sensor->mutex);
+
+ if (sensor->state.streaming) {
+ ret = -EBUSY;
+ goto complete;
+ }
+
+ /* Try to find requested mbus code. */
+ for (index = 0; index < ARRAY_SIZE(ov5648_mbus_codes); index++) {
+ if (ov5648_mbus_codes[index] == mbus_format->code) {
+ mbus_code = mbus_format->code;
+ break;
+ }
+ }
+
+ /* Fallback to default. */
+ if (!mbus_code)
+ mbus_code = ov5648_mbus_codes[0];
+
+ /* Find the mode with nearest dimensions. */
+ mode = v4l2_find_nearest_size(ov5648_modes, ARRAY_SIZE(ov5648_modes),
+ output_size_x, output_size_y,
+ mbus_format->width, mbus_format->height);
+ if (!mode)
+ return -EINVAL;
+
+ ov5648_mbus_format_fill(mbus_format, mbus_code, mode);
+
+ if (format->which == V4L2_SUBDEV_FORMAT_TRY) {
+ *v4l2_subdev_get_try_format(subdev, config, format->pad) =
+ *mbus_format;
+ } else if (sensor->state.mode != mode ||
+ sensor->state.mbus_code != mbus_code) {
+ ret = ov5648_state_configure(sensor, mode, mbus_code);
+ if (ret)
+ goto complete;
+ }
+
+complete:
+ mutex_unlock(&sensor->mutex);
+
+ return ret;
+}
+
+static int ov5648_enum_frame_size(struct v4l2_subdev *subdev,
+ struct v4l2_subdev_pad_config *config,
+ struct v4l2_subdev_frame_size_enum *size_enum)
+{
+ const struct ov5648_mode *mode;
+
+ if (size_enum->index >= ARRAY_SIZE(ov5648_modes))
+ return -EINVAL;
+
+ mode = &ov5648_modes[size_enum->index];
+
+ size_enum->min_width = size_enum->max_width = mode->output_size_x;
+ size_enum->min_height = size_enum->max_height = mode->output_size_y;
+
+ return 0;
+}
+
+static int ov5648_enum_frame_interval(struct v4l2_subdev *subdev,
+ struct v4l2_subdev_pad_config *config,
+ struct v4l2_subdev_frame_interval_enum *interval_enum)
+{
+ const struct ov5648_mode *mode = NULL;
+ unsigned int mode_index;
+ unsigned int interval_index;
+
+ if (interval_enum->index > 0)
+ return -EINVAL;
+
+ /*
+ * Multiple modes with the same dimensions may have different frame
+ * intervals, so look up each relevant mode.
+ */
+ for (mode_index = 0, interval_index = 0;
+ mode_index < ARRAY_SIZE(ov5648_modes); mode_index++) {
+ mode = &ov5648_modes[mode_index];
+
+ if (mode->output_size_x == interval_enum->width &&
+ mode->output_size_y == interval_enum->height) {
+ if (interval_index == interval_enum->index)
+ break;
+
+ interval_index++;
+ }
+ }
+
+ if (mode_index == ARRAY_SIZE(ov5648_modes) || !mode)
+ return -EINVAL;
+
+ switch (interval_enum->code) {
+ case MEDIA_BUS_FMT_SBGGR8_1X8:
+ interval_enum->interval = mode->frame_interval[0];
+ break;
+ case MEDIA_BUS_FMT_SBGGR10_1X10:
+ interval_enum->interval = mode->frame_interval[1];
+ break;
+ default:
+ return -EINVAL;
+ }
+
+ return 0;
+}
+
+static const struct v4l2_subdev_pad_ops ov5648_subdev_pad_ops = {
+ .enum_mbus_code = ov5648_enum_mbus_code,
+ .get_fmt = ov5648_get_fmt,
+ .set_fmt = ov5648_set_fmt,
+ .enum_frame_size = ov5648_enum_frame_size,
+ .enum_frame_interval = ov5648_enum_frame_interval,
+};
+
+static const struct v4l2_subdev_ops ov5648_subdev_ops = {
+ .video = &ov5648_subdev_video_ops,
+ .pad = &ov5648_subdev_pad_ops,
+};
+
+static int ov5648_suspend(struct device *dev)
+{
+ struct i2c_client *client = to_i2c_client(dev);
+ struct v4l2_subdev *subdev = i2c_get_clientdata(client);
+ struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
+ struct ov5648_state *state = &sensor->state;
+ int ret = 0;
+
+ mutex_lock(&sensor->mutex);
+
+ if (state->streaming) {
+ ret = ov5648_sw_standby(sensor, true);
+ if (ret)
+ goto complete;
+ }
+
+ ret = ov5648_sensor_power(sensor, false);
+ if (ret) {
+ ov5648_sw_standby(sensor, false);
+ goto complete;
+ }
+
+complete:
+ mutex_unlock(&sensor->mutex);
+
+ return ret;
+}
+
+static int ov5648_resume(struct device *dev)
+{
+ struct i2c_client *client = to_i2c_client(dev);
+ struct v4l2_subdev *subdev = i2c_get_clientdata(client);
+ struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
+ struct ov5648_state *state = &sensor->state;
+ int ret = 0;
+
+ mutex_lock(&sensor->mutex);
+
+ ret = ov5648_sensor_power(sensor, true);
+ if (ret)
+ goto complete;
+
+ ret = ov5648_sensor_init(sensor);
+ if (ret)
+ goto error_power;
+
+ ret = __v4l2_ctrl_handler_setup(&sensor->ctrls.handler);
+ if (ret)
+ goto error_power;
+
+ if (state->streaming) {
+ ret = ov5648_sw_standby(sensor, false);
+ if (ret)
+ goto error_power;
+ }
+
+ goto complete;
+
+error_power:
+ ov5648_sensor_power(sensor, false);
+
+complete:
+ mutex_unlock(&sensor->mutex);
+
+ return ret;
+}
+
+static int ov5648_probe(struct i2c_client *client)
+{
+ struct device *dev = &client->dev;
+ struct fwnode_handle *handle;
+ struct ov5648_sensor *sensor;
+ struct v4l2_subdev *subdev;
+ struct media_pad *pad;
+ unsigned long rate;
+ int ret;
+
+ sensor = devm_kzalloc(dev, sizeof(*sensor), GFP_KERNEL);
+ if (!sensor)
+ return -ENOMEM;
+
+ sensor->dev = dev;
+ sensor->i2c_client = client;
+
+ /* Graph Endpoint */
+
+ handle = fwnode_graph_get_next_endpoint(dev_fwnode(dev), NULL);
+ if (!handle) {
+ dev_err(dev, "unable to find enpoint node\n");
+ return -EINVAL;
+ }
+
+ sensor->endpoint.bus_type = V4L2_MBUS_CSI2_DPHY;
+
+ ret = v4l2_fwnode_endpoint_alloc_parse(handle, &sensor->endpoint);
+ fwnode_handle_put(handle);
+ if (ret) {
+ dev_err(dev, "failed to parse endpoint node\n");
+ return ret;
+ }
+
+ /* GPIOs */
+
+ sensor->powerdown = devm_gpiod_get_optional(dev, "powerdown",
+ GPIOD_OUT_HIGH);
+ if (IS_ERR(sensor->powerdown)) {
+ ret = PTR_ERR(sensor->powerdown);
+ goto error_endpoint;
+ }
+
+ sensor->reset = devm_gpiod_get_optional(dev, "reset", GPIOD_OUT_HIGH);
+ if (IS_ERR(sensor->reset)) {
+ ret = PTR_ERR(sensor->reset);
+ goto error_endpoint;
+ }
+
+ /* Regulators */
+
+ /* DVDD: digital core */
+ sensor->dvdd = devm_regulator_get(dev, "dvdd");
+ if (IS_ERR(sensor->dvdd)) {
+ dev_err(dev, "cannot get DVDD (digital core) regulator\n");
+ ret = PTR_ERR(sensor->dvdd);
+ goto error_endpoint;
+ }
+
+ /* DOVDD: digital I/O */
+ sensor->dovdd = devm_regulator_get(dev, "dovdd");
+ if (IS_ERR(sensor->dvdd)) {
+ dev_err(dev, "cannot get DOVDD (digital I/O) regulator\n");
+ ret = PTR_ERR(sensor->dvdd);
+ goto error_endpoint;
+ }
+
+ /* AVDD: analog */
+ sensor->avdd = devm_regulator_get_optional(dev, "avdd");
+ if (IS_ERR(sensor->avdd)) {
+ dev_info(dev, "no AVDD regulator provided, using internal\n");
+ sensor->avdd = NULL;
+ }
+
+ /* External Clock */
+
+ sensor->xvclk = devm_clk_get(dev, NULL);
+ if (IS_ERR(sensor->xvclk)) {
+ dev_err(dev, "failed to get external clock\n");
+ ret = PTR_ERR(sensor->xvclk);
+ goto error_endpoint;
+ }
+
+ rate = clk_get_rate(sensor->xvclk);
+ if (rate != OV5648_XVCLK_RATE) {
+ dev_err(dev, "clock rate %lu Hz is unsupported\n", rate);
+ ret = -EINVAL;
+ goto error_endpoint;
+ }
+
+ /* Subdev, entity and pad */
+
+ subdev = &sensor->subdev;
+ v4l2_i2c_subdev_init(subdev, client, &ov5648_subdev_ops);
+
+ subdev->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
+ subdev->entity.function = MEDIA_ENT_F_CAM_SENSOR;
+
+ pad = &sensor->pad;
+ pad->flags = MEDIA_PAD_FL_SOURCE;
+
+ ret = media_entity_pads_init(&subdev->entity, 1, pad);
+ if (ret)
+ goto error_entity;
+
+ /* Mutex */
+
+ mutex_init(&sensor->mutex);
+
+ /* Sensor */
+
+ ret = ov5648_ctrls_init(sensor);
+ if (ret)
+ goto error_mutex;
+
+ ret = ov5648_state_init(sensor);
+ if (ret)
+ goto error_ctrls;
+
+ /* Runtime PM */
+
+ pm_runtime_enable(sensor->dev);
+ pm_runtime_set_suspended(sensor->dev);
+
+ /* V4L2 subdev register */
+
+ ret = v4l2_async_register_subdev_sensor_common(subdev);
+ if (ret)
+ goto error_pm;
+
+ return 0;
+
+error_pm:
+ pm_runtime_disable(sensor->dev);
+
+error_ctrls:
+ v4l2_ctrl_handler_free(&sensor->ctrls.handler);
+
+error_mutex:
+ mutex_destroy(&sensor->mutex);
+
+error_entity:
+ media_entity_cleanup(&sensor->subdev.entity);
+
+error_endpoint:
+ v4l2_fwnode_endpoint_free(&sensor->endpoint);
+
+ return ret;
+}
+
+static int ov5648_remove(struct i2c_client *client)
+{
+ struct v4l2_subdev *subdev = i2c_get_clientdata(client);
+ struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
+
+ v4l2_async_unregister_subdev(subdev);
+ pm_runtime_disable(sensor->dev);
+ v4l2_ctrl_handler_free(&sensor->ctrls.handler);
+ mutex_destroy(&sensor->mutex);
+ media_entity_cleanup(&subdev->entity);
+ v4l2_device_unregister_subdev(subdev);
+
+ return 0;
+}
+
+static const struct dev_pm_ops ov5648_pm_ops = {
+ SET_RUNTIME_PM_OPS(ov5648_suspend, ov5648_resume, NULL)
+};
+
+static const struct of_device_id ov5648_of_match[] = {
+ { .compatible = "ovti,ov5648" },
+ { }
+};
+MODULE_DEVICE_TABLE(of, ov5648_of_match);
+
+static struct i2c_driver ov5648_driver = {
+ .driver = {
+ .name = "ov5648",
+ .of_match_table = ov5648_of_match,
+ .pm = &ov5648_pm_ops,
+ },
+ .probe_new = ov5648_probe,
+ .remove = ov5648_remove,
+};
+
+module_i2c_driver(ov5648_driver);
+
+MODULE_AUTHOR("Paul Kocialkowski <paul.kocialkowski@bootlin.com>");
+MODULE_DESCRIPTION("V4L2 driver for the OmniVision OV5648 image sensor");
+MODULE_LICENSE("GPL v2");
--
2.29.2
^ permalink raw reply related [flat|nested] 5+ messages in thread
* Re: [PATCH v5 2/2] media: i2c: Add support for the OV5648 image sensor
2020-12-11 15:40 ` [PATCH v5 2/2] media: i2c: Add support for the OV5648 image sensor Paul Kocialkowski
@ 2020-12-20 22:39 ` Sakari Ailus
2020-12-31 12:53 ` Paul Kocialkowski
0 siblings, 1 reply; 5+ messages in thread
From: Sakari Ailus @ 2020-12-20 22:39 UTC (permalink / raw)
To: Paul Kocialkowski
Cc: linux-media, devicetree, linux-kernel, linux-arm-kernel,
Mauro Carvalho Chehab, Rob Herring, Maxime Ripard, Hans Verkuil,
Thomas Petazzoni
Hi Paul,
Thanks for the update.
A few more small issues below that I didn't notice earlier. The comments
apply to the other driver as well I believe.
On Fri, Dec 11, 2020 at 04:40:27PM +0100, Paul Kocialkowski wrote:
> The OV5648 is a 5 Mpx CMOS image sensor, connected via MIPI CSI-2
> in a one or two lane configuration.
>
> Most of the features of the hardware are supported, including:
> - Auto and manual exposition/gain
> - Auto and manual white balance
> - Horizontal and vertical flip
> - Test patterns
>
> But the following are still missing:
> - Debanding, based on power source frequency;
> - Exposition setting correlated to time units.
>
> Signed-off-by: Paul Kocialkowski <paul.kocialkowski@bootlin.com>
> ---
> drivers/media/i2c/Kconfig | 13 +
> drivers/media/i2c/Makefile | 1 +
> drivers/media/i2c/ov5648.c | 2638 ++++++++++++++++++++++++++++++++++++
> 3 files changed, 2652 insertions(+)
> create mode 100644 drivers/media/i2c/ov5648.c
>
> diff --git a/drivers/media/i2c/Kconfig b/drivers/media/i2c/Kconfig
> index 878f66ef2719..c0470a8b9a80 100644
> --- a/drivers/media/i2c/Kconfig
> +++ b/drivers/media/i2c/Kconfig
> @@ -922,6 +922,19 @@ config VIDEO_OV5647
> To compile this driver as a module, choose M here: the
> module will be called ov5647.
>
> +config VIDEO_OV5648
> + tristate "OmniVision OV5648 sensor support"
> + depends on I2C && PM && VIDEO_V4L2
> + select MEDIA_CONTROLLER
> + select VIDEO_V4L2_SUBDEV_API
> + select V4L2_FWNODE
> + help
> + This is a Video4Linux2 sensor driver for the OmniVision
> + OV5648 camera.
> +
> + To compile this driver as a module, choose M here: the
> + module will be called ov5648.
> +
> config VIDEO_OV6650
> tristate "OmniVision OV6650 sensor support"
> depends on I2C && VIDEO_V4L2
> diff --git a/drivers/media/i2c/Makefile b/drivers/media/i2c/Makefile
> index f0a77473979d..15d4d6382582 100644
> --- a/drivers/media/i2c/Makefile
> +++ b/drivers/media/i2c/Makefile
> @@ -71,6 +71,7 @@ obj-$(CONFIG_VIDEO_OV2740) += ov2740.o
> obj-$(CONFIG_VIDEO_OV5640) += ov5640.o
> obj-$(CONFIG_VIDEO_OV5645) += ov5645.o
> obj-$(CONFIG_VIDEO_OV5647) += ov5647.o
> +obj-$(CONFIG_VIDEO_OV5648) += ov5648.o
> obj-$(CONFIG_VIDEO_OV5670) += ov5670.o
> obj-$(CONFIG_VIDEO_OV5675) += ov5675.o
> obj-$(CONFIG_VIDEO_OV5695) += ov5695.o
> diff --git a/drivers/media/i2c/ov5648.c b/drivers/media/i2c/ov5648.c
> new file mode 100644
> index 000000000000..4ae6b65ec258
> --- /dev/null
> +++ b/drivers/media/i2c/ov5648.c
> @@ -0,0 +1,2638 @@
> +// SPDX-License-Identifier: GPL-2.0-or-later
> +/*
> + * Copyright (C) 2020 Bootlin
> + * Author: Paul Kocialkowski <paul.kocialkowski@bootlin.com>
> + */
> +
> +#include <linux/clk.h>
> +#include <linux/delay.h>
> +#include <linux/device.h>
> +#include <linux/i2c.h>
> +#include <linux/module.h>
> +#include <linux/of_graph.h>
> +#include <linux/pm_runtime.h>
> +#include <linux/regulator/consumer.h>
> +#include <linux/videodev2.h>
> +#include <media/v4l2-ctrls.h>
> +#include <media/v4l2-device.h>
> +#include <media/v4l2-fwnode.h>
> +#include <media/v4l2-image-sizes.h>
> +#include <media/v4l2-mediabus.h>
> +
> +/* Clock rate */
> +
> +#define OV5648_XVCLK_RATE 24000000
> +
> +/* Register definitions */
> +
> +/* System */
> +
> +#define OV5648_SW_STANDBY_REG 0x100
> +#define OV5648_SW_STANDBY_STREAM_ON BIT(0)
> +
> +#define OV5648_SW_RESET_REG 0x103
> +#define OV5648_SW_RESET_RESET BIT(0)
> +
> +#define OV5648_PAD_OEN0_REG 0x3000
> +#define OV5648_PAD_OEN1_REG 0x3001
> +#define OV5648_PAD_OEN2_REG 0x3002
> +#define OV5648_PAD_OUT0_REG 0x3008
> +#define OV5648_PAD_OUT1_REG 0x3009
> +
> +#define OV5648_CHIP_ID_H_REG 0x300a
> +#define OV5648_CHIP_ID_H_VALUE 0x56
> +#define OV5648_CHIP_ID_L_REG 0x300b
> +#define OV5648_CHIP_ID_L_VALUE 0x48
> +
> +#define OV5648_PAD_OUT2_REG 0x300d
> +#define OV5648_PAD_SEL0_REG 0x300e
> +#define OV5648_PAD_SEL1_REG 0x300f
> +#define OV5648_PAD_SEL2_REG 0x3010
> +#define OV5648_PAD_PK_REG 0x3011
> +#define OV5648_PAD_PK_PD_DATO_EN BIT(7)
> +#define OV5648_PAD_PK_DRIVE_STRENGTH_1X (0 << 5)
> +#define OV5648_PAD_PK_DRIVE_STRENGTH_2X (2 << 5)
> +#define OV5648_PAD_PK_FREX_N BIT(1)
> +
> +#define OV5648_A_PWC_PK_O0_REG 0x3013
> +#define OV5648_A_PWC_PK_O0_BP_REGULATOR_N BIT(3)
> +#define OV5648_A_PWC_PK_O1_REG 0x3014
> +
> +#define OV5648_MIPI_PHY0_REG 0x3016
> +#define OV5648_MIPI_PHY1_REG 0x3017
> +#define OV5648_MIPI_SC_CTRL0_REG 0x3018
> +#define OV5648_MIPI_SC_CTRL0_MIPI_LANES(v) (((v) << 5) & GENMASK(7, 5))
> +#define OV5648_MIPI_SC_CTRL0_PHY_HS_TX_PD BIT(4)
> +#define OV5648_MIPI_SC_CTRL0_PHY_LP_RX_PD BIT(3)
> +#define OV5648_MIPI_SC_CTRL0_MIPI_EN BIT(2)
> +#define OV5648_MIPI_SC_CTRL0_MIPI_SUSP BIT(1)
> +#define OV5648_MIPI_SC_CTRL0_LANE_DIS_OP BIT(0)
> +#define OV5648_MIPI_SC_CTRL1_REG 0x3019
> +#define OV5648_MISC_CTRL0_REG 0x3021
> +#define OV5648_MIPI_SC_CTRL2_REG 0x3022
> +#define OV5648_SUB_ID_REG 0x302a
> +
> +#define OV5648_PLL_CTRL0_REG 0x3034
> +#define OV5648_PLL_CTRL0_PLL_CHARGE_PUMP(v) (((v) << 4) & GENMASK(6, 4))
> +#define OV5648_PLL_CTRL0_BITS(v) ((v) & GENMASK(3, 0))
> +#define OV5648_PLL_CTRL1_REG 0x3035
> +#define OV5648_PLL_CTRL1_SYS_DIV(v) (((v) << 4) & GENMASK(7, 4))
> +#define OV5648_PLL_CTRL1_MIPI_DIV(v) ((v) & GENMASK(3, 0))
> +#define OV5648_PLL_MUL_REG 0x3036
> +#define OV5648_PLL_MUL(v) ((v) & GENMASK(7, 0))
> +#define OV5648_PLL_DIV_REG 0x3037
> +#define OV5648_PLL_DIV_ROOT_DIV(v) ((((v) - 1) << 4) & BIT(4))
> +#define OV5648_PLL_DIV_PLL_PRE_DIV(v) ((v) & GENMASK(3, 0))
> +#define OV5648_PLL_DEBUG_REG 0x3038
> +#define OV5648_PLL_BYPASS_REG 0x3039
> +
> +#define OV5648_PLLS_BYPASS_REG 0x303a
> +#define OV5648_PLLS_MUL_REG 0x303b
> +#define OV5648_PLLS_MUL(v) ((v) & GENMASK(4, 0))
> +#define OV5648_PLLS_CTRL_REG 0x303c
> +#define OV5648_PLLS_CTRL_PLL_CHARGE_PUMP(v) (((v) << 4) & GENMASK(6, 4))
> +#define OV5648_PLLS_CTRL_SYS_DIV(v) ((v) & GENMASK(3, 0))
> +#define OV5648_PLLS_DIV_REG 0x303d
> +#define OV5648_PLLS_DIV_PLLS_PRE_DIV(v) (((v) << 4) & GENMASK(5, 4))
> +#define OV5648_PLLS_DIV_PLLS_DIV_R(v) ((((v) - 1) << 2) & BIT(2))
> +#define OV5648_PLLS_DIV_PLLS_SEL_DIV(v) ((v) & GENMASK(1, 0))
> +
> +#define OV5648_SRB_CTRL_REG 0x3106
> +#define OV5648_SRB_CTRL_SCLK_DIV(v) (((v) << 2) & GENMASK(3, 2))
> +#define OV5648_SRB_CTRL_RESET_ARBITER_EN BIT(1)
> +#define OV5648_SRB_CTRL_SCLK_ARBITER_EN BIT(0)
> +
> +/* Group Hold */
> +
> +#define OV5648_GROUP_ADR0_REG 0x3200
> +#define OV5648_GROUP_ADR1_REG 0x3201
> +#define OV5648_GROUP_ADR2_REG 0x3202
> +#define OV5648_GROUP_ADR3_REG 0x3203
> +#define OV5648_GROUP_LEN0_REG 0x3204
> +#define OV5648_GROUP_LEN1_REG 0x3205
> +#define OV5648_GROUP_LEN2_REG 0x3206
> +#define OV5648_GROUP_LEN3_REG 0x3207
> +#define OV5648_GROUP_ACCESS_REG 0x3208
> +
> +/* Exposure/gain/banding */
> +
> +#define OV5648_EXPOSURE_CTRL_HH_REG 0x3500
> +#define OV5648_EXPOSURE_CTRL_HH(v) (((v) & GENMASK(19, 16)) >> 16)
> +#define OV5648_EXPOSURE_CTRL_HH_VALUE(v) (((v) << 16) & GENMASK(19, 16))
> +#define OV5648_EXPOSURE_CTRL_H_REG 0x3501
> +#define OV5648_EXPOSURE_CTRL_H(v) (((v) & GENMASK(15, 8)) >> 8)
> +#define OV5648_EXPOSURE_CTRL_H_VALUE(v) (((v) << 8) & GENMASK(15, 8))
> +#define OV5648_EXPOSURE_CTRL_L_REG 0x3502
> +#define OV5648_EXPOSURE_CTRL_L(v) ((v) & GENMASK(7, 0))
> +#define OV5648_EXPOSURE_CTRL_L_VALUE(v) ((v) & GENMASK(7, 0))
> +#define OV5648_MANUAL_CTRL_REG 0x3503
> +#define OV5648_MANUAL_CTRL_FRAME_DELAY(v) (((v) << 4) & GENMASK(5, 4))
> +#define OV5648_MANUAL_CTRL_AGC_MANUAL_EN BIT(1)
> +#define OV5648_MANUAL_CTRL_AEC_MANUAL_EN BIT(0)
> +#define OV5648_GAIN_CTRL_H_REG 0x350a
> +#define OV5648_GAIN_CTRL_H(v) (((v) & GENMASK(9, 8)) >> 8)
> +#define OV5648_GAIN_CTRL_H_VALUE(v) (((v) << 8) & GENMASK(9, 8))
> +#define OV5648_GAIN_CTRL_L_REG 0x350b
> +#define OV5648_GAIN_CTRL_L(v) ((v) & GENMASK(7, 0))
> +#define OV5648_GAIN_CTRL_L_VALUE(v) ((v) & GENMASK(7, 0))
> +
> +#define OV5648_ANALOG_CTRL0_REG_BASE 0x3600
> +#define OV5648_ANALOG_CTRL1_REG_BASE 0x3700
> +
> +#define OV5648_AEC_CTRL0_REG 0x3a00
> +#define OV5648_AEC_CTRL0_DEBUG BIT(6)
> +#define OV5648_AEC_CTRL0_DEBAND_EN BIT(5)
> +#define OV5648_AEC_CTRL0_DEBAND_LOW_LIMIT_EN BIT(4)
> +#define OV5648_AEC_CTRL0_START_SEL_EN BIT(3)
> +#define OV5648_AEC_CTRL0_NIGHT_MODE_EN BIT(2)
> +#define OV5648_AEC_CTRL0_FREEZE_EN BIT(0)
> +#define OV5648_EXPOSURE_MIN_REG 0x3a01
> +#define OV5648_EXPOSURE_MAX_60_H_REG 0x3a02
> +#define OV5648_EXPOSURE_MAX_60_L_REG 0x3a03
> +#define OV5648_AEC_CTRL5_REG 0x3a05
> +#define OV5648_AEC_CTRL6_REG 0x3a06
> +#define OV5648_AEC_CTRL7_REG 0x3a07
> +#define OV5648_BANDING_STEP_50_H_REG 0x3a08
> +#define OV5648_BANDING_STEP_50_L_REG 0x3a09
> +#define OV5648_BANDING_STEP_60_H_REG 0x3a0a
> +#define OV5648_BANDING_STEP_60_L_REG 0x3a0b
> +#define OV5648_AEC_CTRLC_REG 0x3a0c
> +#define OV5648_BANDING_MAX_60_REG 0x3a0d
> +#define OV5648_BANDING_MAX_50_REG 0x3a0e
> +#define OV5648_WPT_REG 0x3a0f
> +#define OV5648_BPT_REG 0x3a10
> +#define OV5648_VPT_HIGH_REG 0x3a11
> +#define OV5648_AVG_MANUAL_REG 0x3a12
> +#define OV5648_PRE_GAIN_REG 0x3a13
> +#define OV5648_EXPOSURE_MAX_50_H_REG 0x3a14
> +#define OV5648_EXPOSURE_MAX_50_L_REG 0x3a15
> +#define OV5648_GAIN_BASE_NIGHT_REG 0x3a17
> +#define OV5648_AEC_GAIN_CEILING_H_REG 0x3a18
> +#define OV5648_AEC_GAIN_CEILING_L_REG 0x3a19
> +#define OV5648_DIFF_MAX_REG 0x3a1a
> +#define OV5648_WPT2_REG 0x3a1b
> +#define OV5648_LED_ADD_ROW_H_REG 0x3a1c
> +#define OV5648_LED_ADD_ROW_L_REG 0x3a1d
> +#define OV5648_BPT2_REG 0x3a1e
> +#define OV5648_VPT_LOW_REG 0x3a1f
> +#define OV5648_AEC_CTRL20_REG 0x3a20
> +#define OV5648_AEC_CTRL21_REG 0x3a21
> +
> +#define OV5648_AVG_START_X_H_REG 0x5680
> +#define OV5648_AVG_START_X_L_REG 0x5681
> +#define OV5648_AVG_START_Y_H_REG 0x5682
> +#define OV5648_AVG_START_Y_L_REG 0x5683
> +#define OV5648_AVG_WINDOW_X_H_REG 0x5684
> +#define OV5648_AVG_WINDOW_X_L_REG 0x5685
> +#define OV5648_AVG_WINDOW_Y_H_REG 0x5686
> +#define OV5648_AVG_WINDOW_Y_L_REG 0x5687
> +#define OV5648_AVG_WEIGHT00_REG 0x5688
> +#define OV5648_AVG_WEIGHT01_REG 0x5689
> +#define OV5648_AVG_WEIGHT02_REG 0x568a
> +#define OV5648_AVG_WEIGHT03_REG 0x568b
> +#define OV5648_AVG_WEIGHT04_REG 0x568c
> +#define OV5648_AVG_WEIGHT05_REG 0x568d
> +#define OV5648_AVG_WEIGHT06_REG 0x568e
> +#define OV5648_AVG_WEIGHT07_REG 0x568f
> +#define OV5648_AVG_CTRL10_REG 0x5690
> +#define OV5648_AVG_WEIGHT_SUM_REG 0x5691
> +#define OV5648_AVG_READOUT_REG 0x5693
> +
> +#define OV5648_DIG_CTRL0_REG 0x5a00
> +#define OV5648_DIG_COMP_MAN_H_REG 0x5a02
> +#define OV5648_DIG_COMP_MAN_L_REG 0x5a03
> +
> +#define OV5648_GAINC_MAN_H_REG 0x5a20
> +#define OV5648_GAINC_MAN_L_REG 0x5a21
> +#define OV5648_GAINC_DGC_MAN_H_REG 0x5a22
> +#define OV5648_GAINC_DGC_MAN_L_REG 0x5a23
> +#define OV5648_GAINC_CTRL0_REG 0x5a24
> +
> +#define OV5648_GAINF_ANA_NUM_REG 0x5a40
> +#define OV5648_GAINF_DIG_GAIN_REG 0x5a41
> +
> +/* Timing */
> +
> +#define OV5648_CROP_START_X_H_REG 0x3800
> +#define OV5648_CROP_START_X_H(v) (((v) & GENMASK(11, 8)) >> 8)
> +#define OV5648_CROP_START_X_L_REG 0x3801
> +#define OV5648_CROP_START_X_L(v) ((v) & GENMASK(7, 0))
> +#define OV5648_CROP_START_Y_H_REG 0x3802
> +#define OV5648_CROP_START_Y_H(v) (((v) & GENMASK(11, 8)) >> 8)
> +#define OV5648_CROP_START_Y_L_REG 0x3803
> +#define OV5648_CROP_START_Y_L(v) ((v) & GENMASK(7, 0))
> +#define OV5648_CROP_END_X_H_REG 0x3804
> +#define OV5648_CROP_END_X_H(v) (((v) & GENMASK(11, 8)) >> 8)
> +#define OV5648_CROP_END_X_L_REG 0x3805
> +#define OV5648_CROP_END_X_L(v) ((v) & GENMASK(7, 0))
> +#define OV5648_CROP_END_Y_H_REG 0x3806
> +#define OV5648_CROP_END_Y_H(v) (((v) & GENMASK(11, 8)) >> 8)
> +#define OV5648_CROP_END_Y_L_REG 0x3807
> +#define OV5648_CROP_END_Y_L(v) ((v) & GENMASK(7, 0))
> +#define OV5648_OUTPUT_SIZE_X_H_REG 0x3808
> +#define OV5648_OUTPUT_SIZE_X_H(v) (((v) & GENMASK(11, 8)) >> 8)
> +#define OV5648_OUTPUT_SIZE_X_L_REG 0x3809
> +#define OV5648_OUTPUT_SIZE_X_L(v) ((v) & GENMASK(7, 0))
> +#define OV5648_OUTPUT_SIZE_Y_H_REG 0x380a
> +#define OV5648_OUTPUT_SIZE_Y_H(v) (((v) & GENMASK(11, 8)) >> 8)
> +#define OV5648_OUTPUT_SIZE_Y_L_REG 0x380b
> +#define OV5648_OUTPUT_SIZE_Y_L(v) ((v) & GENMASK(7, 0))
> +#define OV5648_HTS_H_REG 0x380c
> +#define OV5648_HTS_H(v) (((v) & GENMASK(12, 8)) >> 8)
> +#define OV5648_HTS_L_REG 0x380d
> +#define OV5648_HTS_L(v) ((v) & GENMASK(7, 0))
> +#define OV5648_VTS_H_REG 0x380e
> +#define OV5648_VTS_H(v) (((v) & GENMASK(15, 8)) >> 8)
> +#define OV5648_VTS_L_REG 0x380f
> +#define OV5648_VTS_L(v) ((v) & GENMASK(7, 0))
> +#define OV5648_OFFSET_X_H_REG 0x3810
> +#define OV5648_OFFSET_X_H(v) (((v) & GENMASK(11, 8)) >> 8)
> +#define OV5648_OFFSET_X_L_REG 0x3811
> +#define OV5648_OFFSET_X_L(v) ((v) & GENMASK(7, 0))
> +#define OV5648_OFFSET_Y_H_REG 0x3812
> +#define OV5648_OFFSET_Y_H(v) (((v) & GENMASK(11, 8)) >> 8)
> +#define OV5648_OFFSET_Y_L_REG 0x3813
> +#define OV5648_OFFSET_Y_L(v) ((v) & GENMASK(7, 0))
> +#define OV5648_SUB_INC_X_REG 0x3814
> +#define OV5648_SUB_INC_X_ODD(v) (((v) << 4) & GENMASK(7, 4))
> +#define OV5648_SUB_INC_X_EVEN(v) ((v) & GENMASK(3, 0))
> +#define OV5648_SUB_INC_Y_REG 0x3815
> +#define OV5648_SUB_INC_Y_ODD(v) (((v) << 4) & GENMASK(7, 4))
> +#define OV5648_SUB_INC_Y_EVEN(v) ((v) & GENMASK(3, 0))
> +#define OV5648_HSYNCST_H_REG 0x3816
> +#define OV5648_HSYNCST_H(v) (((v) >> 8) & 0xf)
> +#define OV5648_HSYNCST_L_REG 0x3817
> +#define OV5648_HSYNCST_L(v) ((v) & GENMASK(7, 0))
> +#define OV5648_HSYNCW_H_REG 0x3818
> +#define OV5648_HSYNCW_H(v) (((v) >> 8) & 0xf)
> +#define OV5648_HSYNCW_L_REG 0x3819
> +#define OV5648_HSYNCW_L(v) ((v) & GENMASK(7, 0))
> +
> +#define OV5648_TC20_REG 0x3820
> +#define OV5648_TC20_DEBUG BIT(6)
> +#define OV5648_TC20_FLIP_VERT_ISP_EN BIT(2)
> +#define OV5648_TC20_FLIP_VERT_SENSOR_EN BIT(1)
> +#define OV5648_TC20_BINNING_VERT_EN BIT(0)
> +#define OV5648_TC21_REG 0x3821
> +#define OV5648_TC21_FLIP_HORZ_ISP_EN BIT(2)
> +#define OV5648_TC21_FLIP_HORZ_SENSOR_EN BIT(1)
> +#define OV5648_TC21_BINNING_HORZ_EN BIT(0)
> +
> +/* Strobe/exposure */
> +
> +#define OV5648_STROBE_REG 0x3b00
> +#define OV5648_FREX_EXP_HH_REG 0x3b01
> +#define OV5648_SHUTTER_DLY_H_REG 0x3b02
> +#define OV5648_SHUTTER_DLY_L_REG 0x3b03
> +#define OV5648_FREX_EXP_H_REG 0x3b04
> +#define OV5648_FREX_EXP_L_REG 0x3b05
> +#define OV5648_FREX_CTRL_REG 0x3b06
> +#define OV5648_FREX_MODE_SEL_REG 0x3b07
> +#define OV5648_FREX_MODE_SEL_FREX_SA1 BIT(4)
> +#define OV5648_FREX_MODE_SEL_FX1_FM_EN BIT(3)
> +#define OV5648_FREX_MODE_SEL_FREX_INV BIT(2)
> +#define OV5648_FREX_MODE_SEL_MODE1 0x0
> +#define OV5648_FREX_MODE_SEL_MODE2 0x1
> +#define OV5648_FREX_MODE_SEL_ROLLING 0x2
> +#define OV5648_FREX_EXP_REQ_REG 0x3b08
> +#define OV5648_FREX_SHUTTER_DLY_REG 0x3b09
> +#define OV5648_FREX_RST_LEN_REG 0x3b0a
> +#define OV5648_STROBE_WIDTH_HH_REG 0x3b0b
> +#define OV5648_STROBE_WIDTH_H_REG 0x3b0c
> +
> +/* OTP */
> +
> +#define OV5648_OTP_DATA_REG_BASE 0x3d00
> +#define OV5648_OTP_PROGRAM_CTRL_REG 0x3d80
> +#define OV5648_OTP_LOAD_CTRL_REG 0x3d81
> +
> +/* PSRAM */
> +
> +#define OV5648_PSRAM_CTRL1_REG 0x3f01
> +#define OV5648_PSRAM_CTRLF_REG 0x3f0f
> +
> +/* Black Level */
> +
> +#define OV5648_BLC_CTRL0_REG 0x4000
> +#define OV5648_BLC_CTRL1_REG 0x4001
> +#define OV5648_BLC_CTRL1_START_LINE(v) ((v) & GENMASK(5, 0))
> +#define OV5648_BLC_CTRL2_REG 0x4002
> +#define OV5648_BLC_CTRL2_AUTO_EN BIT(6)
> +#define OV5648_BLC_CTRL2_RESET_FRAME_NUM(v) ((v) & GENMASK(5, 0))
> +#define OV5648_BLC_CTRL3_REG 0x4003
> +#define OV5648_BLC_LINE_NUM_REG 0x4004
> +#define OV5648_BLC_LINE_NUM(v) ((v) & GENMASK(7, 0))
> +#define OV5648_BLC_CTRL5_REG 0x4005
> +#define OV5648_BLC_CTRL5_UPDATE_EN BIT(1)
> +#define OV5648_BLC_LEVEL_REG 0x4009
> +
> +/* Frame */
> +
> +#define OV5648_FRAME_CTRL_REG 0x4200
> +#define OV5648_FRAME_ON_NUM_REG 0x4201
> +#define OV5648_FRAME_OFF_NUM_REG 0x4202
> +
> +/* MIPI CSI-2 */
> +
> +#define OV5648_MIPI_CTRL0_REG 0x4800
> +#define OV5648_MIPI_CTRL0_CLK_LANE_AUTOGATE BIT(5)
> +#define OV5648_MIPI_CTRL0_LANE_SYNC_EN BIT(4)
> +#define OV5648_MIPI_CTRL0_LANE_SELECT_LANE1 0
> +#define OV5648_MIPI_CTRL0_LANE_SELECT_LANE2 BIT(3)
> +#define OV5648_MIPI_CTRL0_IDLE_LP00 0
> +#define OV5648_MIPI_CTRL0_IDLE_LP11 BIT(2)
> +
> +#define OV5648_MIPI_CTRL1_REG 0x4801
> +#define OV5648_MIPI_CTRL2_REG 0x4802
> +#define OV5648_MIPI_CTRL3_REG 0x4803
> +#define OV5648_MIPI_CTRL4_REG 0x4804
> +#define OV5648_MIPI_CTRL5_REG 0x4805
> +#define OV5648_MIPI_MAX_FRAME_COUNT_H_REG 0x4810
> +#define OV5648_MIPI_MAX_FRAME_COUNT_L_REG 0x4811
> +#define OV5648_MIPI_CTRL14_REG 0x4814
> +#define OV5648_MIPI_DT_SPKT_REG 0x4815
> +#define OV5648_MIPI_HS_ZERO_MIN_H_REG 0x4818
> +#define OV5648_MIPI_HS_ZERO_MIN_L_REG 0x4819
> +#define OV5648_MIPI_HS_TRAIN_MIN_H_REG 0x481a
> +#define OV5648_MIPI_HS_TRAIN_MIN_L_REG 0x481b
> +#define OV5648_MIPI_CLK_ZERO_MIN_H_REG 0x481c
> +#define OV5648_MIPI_CLK_ZERO_MIN_L_REG 0x481d
> +#define OV5648_MIPI_CLK_PREPARE_MIN_H_REG 0x481e
> +#define OV5648_MIPI_CLK_PREPARE_MIN_L_REG 0x481f
> +#define OV5648_MIPI_CLK_POST_MIN_H_REG 0x4820
> +#define OV5648_MIPI_CLK_POST_MIN_L_REG 0x4821
> +#define OV5648_MIPI_CLK_TRAIL_MIN_H_REG 0x4822
> +#define OV5648_MIPI_CLK_TRAIL_MIN_L_REG 0x4823
> +#define OV5648_MIPI_LPX_P_MIN_H_REG 0x4824
> +#define OV5648_MIPI_LPX_P_MIN_L_REG 0x4825
> +#define OV5648_MIPI_HS_PREPARE_MIN_H_REG 0x4826
> +#define OV5648_MIPI_HS_PREPARE_MIN_L_REG 0x4827
> +#define OV5648_MIPI_HS_EXIT_MIN_H_REG 0x4828
> +#define OV5648_MIPI_HS_EXIT_MIN_L_REG 0x4829
> +#define OV5648_MIPI_HS_ZERO_MIN_UI_REG 0x482a
> +#define OV5648_MIPI_HS_TRAIL_MIN_UI_REG 0x482b
> +#define OV5648_MIPI_CLK_ZERO_MIN_UI_REG 0x482c
> +#define OV5648_MIPI_CLK_PREPARE_MIN_UI_REG 0x482d
> +#define OV5648_MIPI_CLK_POST_MIN_UI_REG 0x482e
> +#define OV5648_MIPI_CLK_TRAIL_MIN_UI_REG 0x482f
> +#define OV5648_MIPI_LPX_P_MIN_UI_REG 0x4830
> +#define OV5648_MIPI_HS_PREPARE_MIN_UI_REG 0x4831
> +#define OV5648_MIPI_HS_EXIT_MIN_UI_REG 0x4832
> +#define OV5648_MIPI_REG_MIN_H_REG 0x4833
> +#define OV5648_MIPI_REG_MIN_L_REG 0x4834
> +#define OV5648_MIPI_REG_MAX_H_REG 0x4835
> +#define OV5648_MIPI_REG_MAX_L_REG 0x4836
> +#define OV5648_MIPI_PCLK_PERIOD_REG 0x4837
> +#define OV5648_MIPI_WKUP_DLY_REG 0x4838
> +#define OV5648_MIPI_LP_GPIO_REG 0x483b
> +#define OV5648_MIPI_SNR_PCLK_DIV_REG 0x4843
> +
> +/* ISP */
> +
> +#define OV5648_ISP_CTRL0_REG 0x5000
> +#define OV5648_ISP_CTRL0_BLACK_CORRECT_EN BIT(2)
> +#define OV5648_ISP_CTRL0_WHITE_CORRECT_EN BIT(1)
> +#define OV5648_ISP_CTRL1_REG 0x5001
> +#define OV5648_ISP_CTRL1_AWB_EN BIT(0)
> +#define OV5648_ISP_CTRL2_REG 0x5002
> +#define OV5648_ISP_CTRL2_WIN_EN BIT(6)
> +#define OV5648_ISP_CTRL2_OTP_EN BIT(1)
> +#define OV5648_ISP_CTRL2_AWB_GAIN_EN BIT(0)
> +#define OV5648_ISP_CTRL3_REG 0x5003
> +#define OV5648_ISP_CTRL3_BUF_EN BIT(3)
> +#define OV5648_ISP_CTRL3_BIN_MAN_SET BIT(2)
> +#define OV5648_ISP_CTRL3_BIN_AUTO_EN BIT(1)
> +#define OV5648_ISP_CTRL4_REG 0x5004
> +#define OV5648_ISP_CTRL5_REG 0x5005
> +#define OV5648_ISP_CTRL6_REG 0x5006
> +#define OV5648_ISP_CTRL7_REG 0x5007
> +#define OV5648_ISP_MAN_OFFSET_X_H_REG 0x5008
> +#define OV5648_ISP_MAN_OFFSET_X_L_REG 0x5009
> +#define OV5648_ISP_MAN_OFFSET_Y_H_REG 0x500a
> +#define OV5648_ISP_MAN_OFFSET_Y_L_REG 0x500b
> +#define OV5648_ISP_MAN_WIN_OFFSET_X_H_REG 0x500c
> +#define OV5648_ISP_MAN_WIN_OFFSET_X_L_REG 0x500d
> +#define OV5648_ISP_MAN_WIN_OFFSET_Y_H_REG 0x500e
> +#define OV5648_ISP_MAN_WIN_OFFSET_Y_L_REG 0x500f
> +#define OV5648_ISP_MAN_WIN_OUTPUT_X_H_REG 0x5010
> +#define OV5648_ISP_MAN_WIN_OUTPUT_X_L_REG 0x5011
> +#define OV5648_ISP_MAN_WIN_OUTPUT_Y_H_REG 0x5012
> +#define OV5648_ISP_MAN_WIN_OUTPUT_Y_L_REG 0x5013
> +#define OV5648_ISP_MAN_INPUT_X_H_REG 0x5014
> +#define OV5648_ISP_MAN_INPUT_X_L_REG 0x5015
> +#define OV5648_ISP_MAN_INPUT_Y_H_REG 0x5016
> +#define OV5648_ISP_MAN_INPUT_Y_L_REG 0x5017
> +#define OV5648_ISP_CTRL18_REG 0x5018
> +#define OV5648_ISP_CTRL19_REG 0x5019
> +#define OV5648_ISP_CTRL1A_REG 0x501a
> +#define OV5648_ISP_CTRL1D_REG 0x501d
> +#define OV5648_ISP_CTRL1F_REG 0x501f
> +#define OV5648_ISP_CTRL1F_OUTPUT_EN 3
> +#define OV5648_ISP_CTRL25_REG 0x5025
> +
> +#define OV5648_ISP_CTRL3D_REG 0x503d
> +#define OV5648_ISP_CTRL3D_PATTERN_EN BIT(7)
> +#define OV5648_ISP_CTRL3D_ROLLING_BAR_EN BIT(6)
> +#define OV5648_ISP_CTRL3D_TRANSPARENT_MODE BIT(5)
> +#define OV5648_ISP_CTRL3D_SQUARES_BW_MODE BIT(4)
> +#define OV5648_ISP_CTRL3D_PATTERN_COLOR_BARS 0
> +#define OV5648_ISP_CTRL3D_PATTERN_RANDOM_DATA 1
> +#define OV5648_ISP_CTRL3D_PATTERN_COLOR_SQUARES 2
> +#define OV5648_ISP_CTRL3D_PATTERN_INPUT 3
> +
> +#define OV5648_ISP_CTRL3E_REG 0x503e
> +#define OV5648_ISP_CTRL4B_REG 0x504b
> +#define OV5648_ISP_CTRL4B_POST_BIN_H_EN BIT(5)
> +#define OV5648_ISP_CTRL4B_POST_BIN_V_EN BIT(4)
> +#define OV5648_ISP_CTRL4C_REG 0x504c
> +#define OV5648_ISP_CTRL57_REG 0x5057
> +#define OV5648_ISP_CTRL58_REG 0x5058
> +#define OV5648_ISP_CTRL59_REG 0x5059
> +
> +#define OV5648_ISP_WINDOW_START_X_H_REG 0x5980
> +#define OV5648_ISP_WINDOW_START_X_L_REG 0x5981
> +#define OV5648_ISP_WINDOW_START_Y_H_REG 0x5982
> +#define OV5648_ISP_WINDOW_START_Y_L_REG 0x5983
> +#define OV5648_ISP_WINDOW_WIN_X_H_REG 0x5984
> +#define OV5648_ISP_WINDOW_WIN_X_L_REG 0x5985
> +#define OV5648_ISP_WINDOW_WIN_Y_H_REG 0x5986
> +#define OV5648_ISP_WINDOW_WIN_Y_L_REG 0x5987
> +#define OV5648_ISP_WINDOW_MAN_REG 0x5988
> +
> +/* White Balance */
> +
> +#define OV5648_AWB_CTRL_REG 0x5180
> +#define OV5648_AWB_CTRL_FAST_AWB BIT(6)
> +#define OV5648_AWB_CTRL_GAIN_FREEZE_EN BIT(5)
> +#define OV5648_AWB_CTRL_SUM_FREEZE_EN BIT(4)
> +#define OV5648_AWB_CTRL_GAIN_MANUAL_EN BIT(3)
> +
> +#define OV5648_AWB_DELTA_REG 0x5181
> +#define OV5648_AWB_STABLE_RANGE_REG 0x5182
> +#define OV5648_AWB_STABLE_RANGE_WIDE_REG 0x5183
> +#define OV5648_HSIZE_MAN_REG 0x5185
> +
> +#define OV5648_GAIN_RED_MAN_H_REG 0x5186
> +#define OV5648_GAIN_RED_MAN_H(v) (((v) & GENMASK(11, 8)) >> 8)
> +#define OV5648_GAIN_RED_MAN_L_REG 0x5187
> +#define OV5648_GAIN_RED_MAN_L(v) ((v) & GENMASK(7, 0))
> +#define OV5648_GAIN_GREEN_MAN_H_REG 0x5188
> +#define OV5648_GAIN_GREEN_MAN_H(v) (((v) & GENMASK(11, 8)) >> 8)
> +#define OV5648_GAIN_GREEN_MAN_L_REG 0x5189
> +#define OV5648_GAIN_GREEN_MAN_L(v) ((v) & GENMASK(7, 0))
> +#define OV5648_GAIN_BLUE_MAN_H_REG 0x518a
> +#define OV5648_GAIN_BLUE_MAN_H(v) (((v) & GENMASK(11, 8)) >> 8)
> +#define OV5648_GAIN_BLUE_MAN_L_REG 0x518b
> +#define OV5648_GAIN_BLUE_MAN_L(v) ((v) & GENMASK(7, 0))
> +#define OV5648_GAIN_RED_LIMIT_REG 0x518c
> +#define OV5648_GAIN_GREEN_LIMIT_REG 0x518d
> +#define OV5648_GAIN_BLUE_LIMIT_REG 0x518e
> +#define OV5648_AWB_FRAME_COUNT_REG 0x518f
> +#define OV5648_AWB_BASE_MAN_REG 0x51df
> +
> +/* Macros */
> +
> +#define ov5648_subdev_sensor(subdev) \
> + container_of(subdev, struct ov5648_sensor, subdev)
Please call the macro argument differently than the struct member. Now the
argument may be only called "subdev".
> +
> +#define ov5648_ctrl_subdev(ctrl) \
> + (&container_of(ctrl->handler, struct ov5648_sensor, ctrls.handler)->subdev)
> +
> +/* Data structures */
> +
> +struct ov5648_register_value {
> + u16 address;
> + u8 value;
> + unsigned int delay_ms;
> +};
> +
> +/*
> + * PLL1 Clock Tree:
> + *
> + * +-< XVCLK
> + * |
> + * +-+ pll_pre_div (0x3037 [3:0], special values: 5: 1.5, 7: 2.5)
> + * |
> + * +-+ pll_mul (0x3036 [7:0])
> + * |
> + * +-+ sys_div (0x3035 [7:4])
> + * |
> + * +-+ mipi_div (0x3035 [3:0])
> + * | |
> + * | +-> MIPI_SCLK
> + * | |
> + * | +-+ mipi_phy_div (2)
> + * | |
> + * | +-> MIPI_CLK
> + * |
> + * +-+ root_div (0x3037 [4])
> + * |
> + * +-+ bit_div (0x3034 [3:0], 8 bits: 2, 10 bits: 2.5, other: 1)
> + * |
> + * +-+ sclk_div (0x3106 [3:2])
> + * |
> + * +-> SCLK
> + * |
> + * +-+ mipi_div (0x3035, 1: PCLK = SCLK)
> + * |
> + * +-> PCLK
> + */
> +
> +struct ov5648_pll1_config {
> + unsigned int pll_pre_div;
> + unsigned int pll_mul;
> + unsigned int sys_div;
> + unsigned int root_div;
> + unsigned int sclk_div;
> + unsigned int mipi_div;
> +};
> +
> +/*
> + * PLL2 Clock Tree:
> + *
> + * +-< XVCLK
> + * |
> + * +-+ plls_pre_div (0x303d [5:4], special values: 0: 1, 1: 1.5)
> + * |
> + * +-+ plls_div_r (0x303d [2])
> + * |
> + * +-+ plls_mul (0x303b [4:0])
> + * |
> + * +-+ sys_div (0x303c [3:0])
> + * |
> + * +-+ sel_div (0x303d [1:0], special values: 0: 1, 3: 2.5)
> + * |
> + * +-> ADCLK
> + */
> +
> +struct ov5648_pll2_config {
> + unsigned int plls_pre_div;
> + unsigned int plls_div_r;
> + unsigned int plls_mul;
> + unsigned int sys_div;
> + unsigned int sel_div;
> +};
> +
> +/*
> + * General formulas for (array-centered) mode calculation:
> + * - photo_array_width = 2624
> + * - crop_start_x = (photo_array_width - output_size_x) / 2
> + * - crop_end_x = crop_start_x + offset_x + output_size_x - 1
> + *
> + * - photo_array_height = 1956
> + * - crop_start_y = (photo_array_height - output_size_y) / 2
> + * - crop_end_y = crop_start_y + offset_y + output_size_y - 1
> + */
> +
> +struct ov5648_mode {
> + unsigned int crop_start_x;
> + unsigned int offset_x;
> + unsigned int output_size_x;
> + unsigned int crop_end_x;
> + unsigned int hts;
> +
> + unsigned int crop_start_y;
> + unsigned int offset_y;
> + unsigned int output_size_y;
> + unsigned int crop_end_y;
> + unsigned int vts;
> +
> + bool binning_x;
> + bool binning_y;
> +
> + unsigned int inc_x_odd;
> + unsigned int inc_x_even;
> + unsigned int inc_y_odd;
> + unsigned int inc_y_even;
> +
> + /* 8-bit frame interval followed by 10-bit frame interval. */
> + struct v4l2_fract frame_interval[2];
> +
> + /* 8-bit config followed by 10-bit config. */
> + const struct ov5648_pll1_config *pll1_config[2];
> + const struct ov5648_pll2_config *pll2_config;
> +
> + const struct ov5648_register_value *register_values;
> + unsigned int register_values_count;
> +};
> +
> +struct ov5648_state {
> + const struct ov5648_mode *mode;
> + u32 mbus_code;
> +
> + bool streaming;
> +};
> +
> +struct ov5648_ctrls {
> + struct v4l2_ctrl *exposure_auto;
> + struct v4l2_ctrl *exposure;
> +
> + struct v4l2_ctrl *gain_auto;
> + struct v4l2_ctrl *gain;
> +
> + struct v4l2_ctrl *white_balance_auto;
> + struct v4l2_ctrl *red_balance;
> + struct v4l2_ctrl *blue_balance;
> +
> + struct v4l2_ctrl *link_freq;
> + struct v4l2_ctrl *pixel_rate;
> +
> + struct v4l2_ctrl_handler handler;
> +} __packed;
> +
> +struct ov5648_sensor {
> + struct device *dev;
> + struct i2c_client *i2c_client;
> + struct gpio_desc *reset;
> + struct gpio_desc *powerdown;
> + struct regulator *avdd;
> + struct regulator *dvdd;
> + struct regulator *dovdd;
> + struct clk *xvclk;
> +
> + struct v4l2_fwnode_endpoint endpoint;
> + struct v4l2_subdev subdev;
> + struct media_pad pad;
> +
> + struct mutex mutex;
> +
> + struct ov5648_state state;
> + struct ov5648_ctrls ctrls;
> +};
> +
> +/* Static definitions */
> +
> +/*
> + * XVCLK = 24 MHz
> + * SCLK = 84 MHz
> + * PCLK = 84 MHz
> + */
> +static const struct ov5648_pll1_config ov5648_pll1_config_native_8_bits = {
> + .pll_pre_div = 3,
> + .pll_mul = 84,
> + .sys_div = 2,
> + .root_div = 1,
> + .sclk_div = 1,
> + .mipi_div = 1,
> +};
> +
> +/*
> + * XVCLK = 24 MHz
> + * SCLK = 84 MHz
> + * PCLK = 84 MHz
> + */
> +static const struct ov5648_pll1_config ov5648_pll1_config_native_10_bits = {
> + .pll_pre_div = 3,
> + .pll_mul = 105,
> + .sys_div = 2,
> + .root_div = 1,
> + .sclk_div = 1,
> + .mipi_div = 1,
> +};
> +
> +/*
> + * XVCLK = 24 MHz
> + * ADCLK = 200 MHz
> + */
> +static const struct ov5648_pll2_config ov5648_pll2_config_native = {
> + .plls_pre_div = 3,
> + .plls_div_r = 1,
> + .plls_mul = 25,
> + .sys_div = 1,
> + .sel_div = 1,
> +};
> +
> +static const struct ov5648_mode ov5648_modes[] = {
> + /* 2592x1944 */
> + {
> + /* Horizontal */
> + .crop_start_x = 16,
> + .offset_x = 0,
> + .output_size_x = 2592,
> + .crop_end_x = 2607,
> + .hts = 2816,
> +
> + /* Vertical */
> + .crop_start_y = 6,
> + .offset_y = 0,
> + .output_size_y = 1944,
> + .crop_end_y = 1949,
> + .vts = 1984,
> +
> + /* Subsample increase */
> + .inc_x_odd = 1,
> + .inc_x_even = 1,
> + .inc_y_odd = 1,
> + .inc_y_even = 1,
> +
> + /* Frame Interval */
> + .frame_interval = {
> + { 1, 15 },
> + { 1, 15 },
> + },
> +
> + /* PLL */
> + .pll1_config = {
> + &ov5648_pll1_config_native_8_bits,
> + &ov5648_pll1_config_native_10_bits,
> + },
> + .pll2_config = &ov5648_pll2_config_native,
> + },
> + /* 1600x1200 (UXGA) */
> + {
> + /* Horizontal */
> + .crop_start_x = 512,
> + .offset_x = 0,
> + .output_size_x = 1600,
> + .crop_end_x = 2111,
> + .hts = 2816,
> +
> + /* Vertical */
> + .crop_start_y = 378,
> + .offset_y = 0,
> + .output_size_y = 1200,
> + .crop_end_y = 1577,
> + .vts = 1984,
> +
> + /* Subsample increase */
> + .inc_x_odd = 1,
> + .inc_x_even = 1,
> + .inc_y_odd = 1,
> + .inc_y_even = 1,
> +
> + /* Frame Interval */
> + .frame_interval = {
> + { 1, 15 },
> + { 1, 15 },
> + },
> +
> + /* PLL */
> + .pll1_config = {
> + &ov5648_pll1_config_native_8_bits,
> + &ov5648_pll1_config_native_10_bits,
> + },
> + .pll2_config = &ov5648_pll2_config_native,
> + },
> + /* 1920x1080 (Full HD) */
> + {
> + /* Horizontal */
> + .crop_start_x = 352,
> + .offset_x = 0,
> + .output_size_x = 1920,
> + .crop_end_x = 2271,
> + .hts = 2816,
> +
> + /* Vertical */
> + .crop_start_y = 438,
> + .offset_y = 0,
> + .output_size_y = 1080,
> + .crop_end_y = 1517,
> + .vts = 1984,
> +
> + /* Subsample increase */
> + .inc_x_odd = 1,
> + .inc_x_even = 1,
> + .inc_y_odd = 1,
> + .inc_y_even = 1,
> +
> + /* Frame Interval */
> + .frame_interval = {
> + { 1, 15 },
> + { 1, 15 },
> + },
> +
> + /* PLL */
> + .pll1_config = {
> + &ov5648_pll1_config_native_8_bits,
> + &ov5648_pll1_config_native_10_bits,
> + },
> + .pll2_config = &ov5648_pll2_config_native,
> + },
> + /* 1280x960 */
> + {
> + /* Horizontal */
> + .crop_start_x = 16,
> + .offset_x = 8,
> + .output_size_x = 1280,
> + .crop_end_x = 2607,
> + .hts = 1912,
> +
> + /* Vertical */
> + .crop_start_y = 6,
> + .offset_y = 6,
> + .output_size_y = 960,
> + .crop_end_y = 1949,
> + .vts = 1496,
> +
> + /* Binning */
> + .binning_x = true,
> +
> + /* Subsample increase */
> + .inc_x_odd = 3,
> + .inc_x_even = 1,
> + .inc_y_odd = 3,
> + .inc_y_even = 1,
> +
> + /* Frame Interval */
> + .frame_interval = {
> + { 1, 30 },
> + { 1, 30 },
> + },
> +
> + /* PLL */
> + .pll1_config = {
> + &ov5648_pll1_config_native_8_bits,
> + &ov5648_pll1_config_native_10_bits,
> + },
> + .pll2_config = &ov5648_pll2_config_native,
> + },
> + /* 1280x720 (HD) */
> + {
> + /* Horizontal */
> + .crop_start_x = 16,
> + .offset_x = 8,
> + .output_size_x = 1280,
> + .crop_end_x = 2607,
> + .hts = 1912,
> +
> + /* Vertical */
> + .crop_start_y = 254,
> + .offset_y = 2,
> + .output_size_y = 720,
> + .crop_end_y = 1701,
> + .vts = 1496,
> +
> + /* Binning */
> + .binning_x = true,
> +
> + /* Subsample increase */
> + .inc_x_odd = 3,
> + .inc_x_even = 1,
> + .inc_y_odd = 3,
> + .inc_y_even = 1,
> +
> + /* Frame Interval */
> + .frame_interval = {
> + { 1, 30 },
> + { 1, 30 },
> + },
> +
> + /* PLL */
> + .pll1_config = {
> + &ov5648_pll1_config_native_8_bits,
> + &ov5648_pll1_config_native_10_bits,
> + },
> + .pll2_config = &ov5648_pll2_config_native,
> + },
> + /* 640x480 (VGA) */
> + {
> + /* Horizontal */
> + .crop_start_x = 0,
> + .offset_x = 8,
> + .output_size_x = 640,
> + .crop_end_x = 2623,
> + .hts = 1896,
> +
> + /* Vertical */
> + .crop_start_y = 0,
> + .offset_y = 2,
> + .output_size_y = 480,
> + .crop_end_y = 1953,
> + .vts = 984,
> +
> + /* Binning */
> + .binning_x = true,
> +
> + /* Subsample increase */
> + .inc_x_odd = 7,
> + .inc_x_even = 1,
> + .inc_y_odd = 7,
> + .inc_y_even = 1,
> +
> + /* Frame Interval */
> + .frame_interval = {
> + { 1, 30 },
> + { 1, 30 },
> + },
> +
> + /* PLL */
> + .pll1_config = {
> + &ov5648_pll1_config_native_8_bits,
> + &ov5648_pll1_config_native_10_bits,
> + },
> + .pll2_config = &ov5648_pll2_config_native,
> + },
> +};
> +
> +static const u32 ov5648_mbus_codes[] = {
> + MEDIA_BUS_FMT_SBGGR8_1X8,
> + MEDIA_BUS_FMT_SBGGR10_1X10,
> +};
> +
> +static const struct ov5648_register_value ov5648_init_sequence[] = {
> + /* PSRAM */
> + { OV5648_PSRAM_CTRL1_REG, 0x0d },
> + { OV5648_PSRAM_CTRLF_REG, 0xf5 },
> +};
> +
> +static const s64 ov5648_link_freq_menu[] = {
> + 210000000,
> + 168000000,
> +};
> +
> +static const char *const ov5648_test_pattern_menu[] = {
> + "Disabled",
> + "Random data",
> + "Color bars",
> + "Color bars with rolling bar",
> + "Color squares",
> + "Color squares with rolling bar"
> +};
> +
> +static const u8 ov5648_test_pattern_bits[] = {
> + 0,
> + OV5648_ISP_CTRL3D_PATTERN_EN | OV5648_ISP_CTRL3D_PATTERN_RANDOM_DATA,
> + OV5648_ISP_CTRL3D_PATTERN_EN | OV5648_ISP_CTRL3D_PATTERN_COLOR_BARS,
> + OV5648_ISP_CTRL3D_PATTERN_EN | OV5648_ISP_CTRL3D_ROLLING_BAR_EN |
> + OV5648_ISP_CTRL3D_PATTERN_COLOR_BARS,
> + OV5648_ISP_CTRL3D_PATTERN_EN | OV5648_ISP_CTRL3D_PATTERN_COLOR_SQUARES,
> + OV5648_ISP_CTRL3D_PATTERN_EN | OV5648_ISP_CTRL3D_ROLLING_BAR_EN |
> + OV5648_ISP_CTRL3D_PATTERN_COLOR_SQUARES,
> +};
> +
> +/* Input/Output */
> +
> +static int ov5648_read(struct ov5648_sensor *sensor, u16 address, u8 *value)
> +{
> + unsigned char data[2] = { address >> 8, address & 0xff };
> + struct i2c_client *client = sensor->i2c_client;
> + int ret;
> +
> + ret = i2c_master_send(client, data, sizeof(data));
> + if (ret < 0) {
> + dev_dbg(&client->dev, "i2c send error at address %#04x\n",
> + address);
> + return ret;
> + }
> +
> + ret = i2c_master_recv(client, value, 1);
> + if (ret < 0) {
> + dev_dbg(&client->dev, "i2c recv error at address %#04x\n",
> + address);
> + return ret;
> + }
> +
> + return 0;
> +}
> +
> +static int ov5648_write(struct ov5648_sensor *sensor, u16 address, u8 value)
> +{
> + unsigned char data[3] = { address >> 8, address & 0xff, value };
> + struct i2c_client *client = sensor->i2c_client;
> + int ret;
> +
> + ret = i2c_master_send(client, data, sizeof(data));
> + if (ret < 0) {
> + dev_dbg(&client->dev, "i2c send error at address %#04x\n",
> + address);
> + return ret;
> + }
> +
> + return 0;
> +}
> +
> +static int ov5648_write_sequence(struct ov5648_sensor *sensor,
> + const struct ov5648_register_value *sequence,
> + unsigned int sequence_count)
> +{
> + unsigned int i;
> + int ret = 0;
> +
> + for (i = 0; i < sequence_count; i++) {
> + ret = ov5648_write(sensor, sequence[i].address,
> + sequence[i].value);
> + if (ret)
> + break;
> +
> + if (sequence[i].delay_ms)
> + msleep(sequence[i].delay_ms);
> + }
> +
> + return ret;
> +}
> +
> +static int ov5648_update_bits(struct ov5648_sensor *sensor, u16 address,
> + u8 mask, u8 bits)
> +{
> + u8 value = 0;
> + int ret;
> +
> + ret = ov5648_read(sensor, address, &value);
> + if (ret)
> + return ret;
> +
> + value &= ~mask;
> + value |= bits;
> +
> + ret = ov5648_write(sensor, address, value);
> + if (ret)
> + return ret;
> +
> + return 0;
> +}
> +
> +/* Sensor */
> +
> +static int ov5648_sw_reset(struct ov5648_sensor *sensor)
> +{
> + int ret;
> +
> + ret = ov5648_write(sensor, OV5648_SW_RESET_REG, OV5648_SW_RESET_RESET);
return ov5648_write(...);
There seem to be a few others like that left.
> + if (ret < 0)
> + return ret;
> +
> + return 0;
> +}
> +
> +static int ov5648_sw_standby(struct ov5648_sensor *sensor, int standby)
> +{
> + u8 value = 0;
> + int ret;
> +
> + if (!standby)
> + value = OV5648_SW_STANDBY_STREAM_ON;
> +
> + ret = ov5648_write(sensor, OV5648_SW_STANDBY_REG, value);
> + if (ret < 0)
> + return ret;
> +
> + return 0;
> +}
> +
> +static int ov5648_chip_id_check(struct ov5648_sensor *sensor)
> +{
> + u16 regs[] = { OV5648_CHIP_ID_H_REG, OV5648_CHIP_ID_L_REG };
> + u8 values[] = { OV5648_CHIP_ID_H_VALUE, OV5648_CHIP_ID_L_VALUE };
> + unsigned int i;
> + u8 value;
> + int ret;
> +
> + for (i = 0; i < ARRAY_SIZE(regs); i++) {
> + ret = ov5648_read(sensor, regs[i], &value);
> + if (ret < 0)
> + return ret;
> +
> + if (value != values[i]) {
> + dev_err(sensor->dev,
> + "chip id value mismatch: %#x instead of %#x\n",
> + value, values[i]);
> + return -EINVAL;
> + }
> + }
> +
> + return 0;
> +}
> +
> +static int ov5648_avdd_internal_power(struct ov5648_sensor *sensor, int on)
> +{
> + return ov5648_write(sensor, OV5648_A_PWC_PK_O0_REG,
> + on ? 0 : OV5648_A_PWC_PK_O0_BP_REGULATOR_N);
> +}
> +
> +static int ov5648_pad_configure(struct ov5648_sensor *sensor)
> +{
> + int ret;
> +
> + /* Configure pads as input. */
> +
> + ret = ov5648_write(sensor, OV5648_PAD_OEN1_REG, 0);
> + if (ret)
> + return ret;
> +
> + ret = ov5648_write(sensor, OV5648_PAD_OEN2_REG, 0);
> + if (ret)
> + return ret;
> +
> + /* Disable FREX pin. */
> +
> + return ov5648_write(sensor, OV5648_PAD_PK_REG,
> + OV5648_PAD_PK_DRIVE_STRENGTH_1X |
> + OV5648_PAD_PK_FREX_N);
> +}
> +
> +static int ov5648_mipi_configure(struct ov5648_sensor *sensor)
> +{
> + struct v4l2_fwnode_bus_mipi_csi2 *bus_mipi_csi2 =
> + &sensor->endpoint.bus.mipi_csi2;
> + unsigned int lanes_count = bus_mipi_csi2->num_data_lanes;
> + int ret;
> +
> + ret = ov5648_write(sensor, OV5648_MIPI_CTRL0_REG,
> + OV5648_MIPI_CTRL0_CLK_LANE_AUTOGATE |
> + OV5648_MIPI_CTRL0_LANE_SELECT_LANE1 |
> + OV5648_MIPI_CTRL0_IDLE_LP11);
> + if (ret)
> + return ret;
> +
> + return ov5648_write(sensor, OV5648_MIPI_SC_CTRL0_REG,
> + OV5648_MIPI_SC_CTRL0_MIPI_LANES(lanes_count) |
> + OV5648_MIPI_SC_CTRL0_PHY_LP_RX_PD |
> + OV5648_MIPI_SC_CTRL0_MIPI_EN);
> +}
> +
> +static int ov5648_black_level_configure(struct ov5648_sensor *sensor)
> +{
> + int ret;
> +
> + /* Up to 6 lines are available for black level calibration. */
> +
> + ret = ov5648_write(sensor, OV5648_BLC_CTRL1_REG,
> + OV5648_BLC_CTRL1_START_LINE(2));
> + if (ret)
> + return ret;
> +
> + ret = ov5648_write(sensor, OV5648_BLC_CTRL2_REG,
> + OV5648_BLC_CTRL2_AUTO_EN |
> + OV5648_BLC_CTRL2_RESET_FRAME_NUM(5));
> + if (ret)
> + return ret;
> +
> + ret = ov5648_write(sensor, OV5648_BLC_LINE_NUM_REG,
> + OV5648_BLC_LINE_NUM(4));
> + if (ret)
> + return ret;
> +
> + return ov5648_update_bits(sensor, OV5648_BLC_CTRL5_REG,
> + OV5648_BLC_CTRL5_UPDATE_EN,
> + OV5648_BLC_CTRL5_UPDATE_EN);
> +}
> +
> +static int ov5648_isp_configure(struct ov5648_sensor *sensor)
> +{
> + u8 bits;
> + int ret;
> +
> + /* Enable black and white level correction. */
> + bits = OV5648_ISP_CTRL0_BLACK_CORRECT_EN |
> + OV5648_ISP_CTRL0_WHITE_CORRECT_EN;
> +
> + ret = ov5648_update_bits(sensor, OV5648_ISP_CTRL0_REG, bits, bits);
> + if (ret)
> + return ret;
> +
> + /* Enable AWB. */
> + ret = ov5648_write(sensor, OV5648_ISP_CTRL1_REG,
> + OV5648_ISP_CTRL1_AWB_EN);
> + if (ret)
> + return ret;
> +
> + /* Enable AWB gain and windowing. */
> + ret = ov5648_write(sensor, OV5648_ISP_CTRL2_REG,
> + OV5648_ISP_CTRL2_WIN_EN |
> + OV5648_ISP_CTRL2_AWB_GAIN_EN);
> + if (ret)
> + return ret;
> +
> + /* Enable buffering and auto-binning. */
> + ret = ov5648_write(sensor, OV5648_ISP_CTRL3_REG,
> + OV5648_ISP_CTRL3_BUF_EN |
> + OV5648_ISP_CTRL3_BIN_AUTO_EN);
> + if (ret)
> + return ret;
> +
> + ret = ov5648_write(sensor, OV5648_ISP_CTRL4_REG, 0);
> + if (ret)
> + return ret;
> +
> + ret = ov5648_write(sensor, OV5648_ISP_CTRL1F_REG,
> + OV5648_ISP_CTRL1F_OUTPUT_EN);
> + if (ret)
> + return ret;
> +
> + /* Enable post-binning filters. */
> + ret = ov5648_write(sensor, OV5648_ISP_CTRL4B_REG,
> + OV5648_ISP_CTRL4B_POST_BIN_H_EN |
> + OV5648_ISP_CTRL4B_POST_BIN_V_EN);
> + if (ret)
> + return ret;
> +
> + /* Disable debanding and night mode. Debug bit seems necessary. */
> + ret = ov5648_write(sensor, OV5648_AEC_CTRL0_REG,
> + OV5648_AEC_CTRL0_DEBUG |
> + OV5648_AEC_CTRL0_START_SEL_EN);
> + if (ret)
> + return ret;
> +
> + return ov5648_write(sensor, OV5648_MANUAL_CTRL_REG,
> + OV5648_MANUAL_CTRL_FRAME_DELAY(1));
> +}
> +
> +static unsigned long ov5648_mode_pll1_rate(struct ov5648_sensor *sensor,
> + const struct ov5648_pll1_config *config)
> +{
> + unsigned long xvclk_rate;
> + unsigned long pll1_rate;
> +
> + xvclk_rate = clk_get_rate(sensor->xvclk);
> + pll1_rate = xvclk_rate * config->pll_mul;
> +
> + switch (config->pll_pre_div) {
> + case 5:
> + pll1_rate *= 3;
> + pll1_rate /= 2;
> + break;
> + case 7:
> + pll1_rate *= 5;
> + pll1_rate /= 2;
> + break;
> + default:
> + pll1_rate /= config->pll_pre_div;
> + break;
> + }
> +
> + return pll1_rate;
> +}
> +
> +static int ov5648_mode_pll1_configure(struct ov5648_sensor *sensor,
> + const struct ov5648_mode *mode,
> + u32 mbus_code)
> +{
> + const struct ov5648_pll1_config *config;
> + u8 value;
> + int ret;
> +
> + value = OV5648_PLL_CTRL0_PLL_CHARGE_PUMP(1);
> +
> + switch (mbus_code) {
> + case MEDIA_BUS_FMT_SBGGR8_1X8:
> + config = mode->pll1_config[0];
> + value |= OV5648_PLL_CTRL0_BITS(8);
> + break;
> + case MEDIA_BUS_FMT_SBGGR10_1X10:
> + config = mode->pll1_config[1];
> + value |= OV5648_PLL_CTRL0_BITS(10);
> + break;
> + default:
> + return -EINVAL;
> + }
> +
> + ret = ov5648_write(sensor, OV5648_PLL_CTRL0_REG, value);
> + if (ret)
> + return ret;
> +
> + ret = ov5648_write(sensor, OV5648_PLL_DIV_REG,
> + OV5648_PLL_DIV_ROOT_DIV(config->root_div) |
> + OV5648_PLL_DIV_PLL_PRE_DIV(config->pll_pre_div));
> + if (ret)
> + return ret;
> +
> + ret = ov5648_write(sensor, OV5648_PLL_MUL_REG,
> + OV5648_PLL_MUL(config->pll_mul));
> + if (ret)
> + return ret;
> +
> + ret = ov5648_write(sensor, OV5648_PLL_CTRL1_REG,
> + OV5648_PLL_CTRL1_SYS_DIV(config->sys_div) |
> + OV5648_PLL_CTRL1_MIPI_DIV(config->mipi_div));
> + if (ret)
> + return ret;
> +
> + return ov5648_write(sensor, OV5648_SRB_CTRL_REG,
> + OV5648_SRB_CTRL_SCLK_DIV(config->sclk_div) |
> + OV5648_SRB_CTRL_SCLK_ARBITER_EN);
> +}
> +
> +static int ov5648_mode_pll2_configure(struct ov5648_sensor *sensor,
> + const struct ov5648_mode *mode)
> +{
> + const struct ov5648_pll2_config *config = mode->pll2_config;
> + int ret;
> +
> + ret = ov5648_write(sensor, OV5648_PLLS_DIV_REG,
> + OV5648_PLLS_DIV_PLLS_PRE_DIV(config->plls_pre_div) |
> + OV5648_PLLS_DIV_PLLS_DIV_R(config->plls_div_r) |
> + OV5648_PLLS_DIV_PLLS_SEL_DIV(config->sel_div));
> + if (ret)
> + return ret;
> +
> + ret = ov5648_write(sensor, OV5648_PLLS_MUL_REG,
> + OV5648_PLLS_MUL(config->plls_mul));
> + if (ret)
> + return ret;
> +
> + return ov5648_write(sensor, OV5648_PLLS_CTRL_REG,
> + OV5648_PLLS_CTRL_PLL_CHARGE_PUMP(1) |
> + OV5648_PLLS_CTRL_SYS_DIV(config->sys_div));
> +}
> +
> +static int ov5648_mode_configure(struct ov5648_sensor *sensor,
> + const struct ov5648_mode *mode, u32 mbus_code)
> +{
> + int ret;
> +
> + /* Crop Start X */
> +
> + ret = ov5648_write(sensor, OV5648_CROP_START_X_H_REG,
> + OV5648_CROP_START_X_H(mode->crop_start_x));
> + if (ret)
> + return ret;
> +
> + ret = ov5648_write(sensor, OV5648_CROP_START_X_L_REG,
> + OV5648_CROP_START_X_L(mode->crop_start_x));
> + if (ret)
> + return ret;
> +
> + /* Offset X */
> +
> + ret = ov5648_write(sensor, OV5648_OFFSET_X_H_REG,
> + OV5648_OFFSET_X_H(mode->offset_x));
> + if (ret)
> + return ret;
> +
> + ret = ov5648_write(sensor, OV5648_OFFSET_X_L_REG,
> + OV5648_OFFSET_X_L(mode->offset_x));
> + if (ret)
> + return ret;
> +
> + /* Output Size X */
> +
> + ret = ov5648_write(sensor, OV5648_OUTPUT_SIZE_X_H_REG,
> + OV5648_OUTPUT_SIZE_X_H(mode->output_size_x));
> + if (ret)
> + return ret;
> +
> + ret = ov5648_write(sensor, OV5648_OUTPUT_SIZE_X_L_REG,
> + OV5648_OUTPUT_SIZE_X_L(mode->output_size_x));
> + if (ret)
> + return ret;
> +
> + /* Crop End X */
> +
> + ret = ov5648_write(sensor, OV5648_CROP_END_X_H_REG,
> + OV5648_CROP_END_X_H(mode->crop_end_x));
> + if (ret)
> + return ret;
> +
> + ret = ov5648_write(sensor, OV5648_CROP_END_X_L_REG,
> + OV5648_CROP_END_X_L(mode->crop_end_x));
> + if (ret)
> + return ret;
> +
> + /* Horizontal Total Size */
> +
> + ret = ov5648_write(sensor, OV5648_HTS_H_REG, OV5648_HTS_H(mode->hts));
> + if (ret)
> + return ret;
> +
> + ret = ov5648_write(sensor, OV5648_HTS_L_REG, OV5648_HTS_L(mode->hts));
> + if (ret)
> + return ret;
> +
> + /* Crop Start Y */
> +
> + ret = ov5648_write(sensor, OV5648_CROP_START_Y_H_REG,
> + OV5648_CROP_START_Y_H(mode->crop_start_y));
> + if (ret)
> + return ret;
> +
> + ret = ov5648_write(sensor, OV5648_CROP_START_Y_L_REG,
> + OV5648_CROP_START_Y_L(mode->crop_start_y));
> + if (ret)
> + return ret;
> +
> + /* Offset Y */
> +
> + ret = ov5648_write(sensor, OV5648_OFFSET_Y_H_REG,
> + OV5648_OFFSET_Y_H(mode->offset_y));
> + if (ret)
> + return ret;
> +
> + ret = ov5648_write(sensor, OV5648_OFFSET_Y_L_REG,
> + OV5648_OFFSET_Y_L(mode->offset_y));
> + if (ret)
> + return ret;
> +
> + /* Output Size Y */
> +
> + ret = ov5648_write(sensor, OV5648_OUTPUT_SIZE_Y_H_REG,
> + OV5648_OUTPUT_SIZE_Y_H(mode->output_size_y));
> + if (ret)
> + return ret;
> +
> + ret = ov5648_write(sensor, OV5648_OUTPUT_SIZE_Y_L_REG,
> + OV5648_OUTPUT_SIZE_Y_L(mode->output_size_y));
> + if (ret)
> + return ret;
> +
> + /* Crop End Y */
> +
> + ret = ov5648_write(sensor, OV5648_CROP_END_Y_H_REG,
> + OV5648_CROP_END_Y_H(mode->crop_end_y));
> + if (ret)
> + return ret;
> +
> + ret = ov5648_write(sensor, OV5648_CROP_END_Y_L_REG,
> + OV5648_CROP_END_Y_L(mode->crop_end_y));
> + if (ret)
> + return ret;
> +
> + /* Vertical Total Size */
> +
> + ret = ov5648_write(sensor, OV5648_VTS_H_REG, OV5648_VTS_H(mode->vts));
> + if (ret)
> + return ret;
> +
> + ret = ov5648_write(sensor, OV5648_VTS_L_REG, OV5648_VTS_L(mode->vts));
> + if (ret)
> + return ret;
> +
> + /* Flip/Mirror/Binning */
> +
> + /*
> + * A debug bit is enabled by default and needs to be cleared for
> + * subsampling to work.
> + */
> + ret = ov5648_update_bits(sensor, OV5648_TC20_REG,
> + OV5648_TC20_DEBUG |
> + OV5648_TC20_BINNING_VERT_EN,
> + mode->binning_y ? OV5648_TC20_BINNING_VERT_EN :
> + 0);
> + if (ret)
> + return ret;
> +
> + ret = ov5648_update_bits(sensor, OV5648_TC21_REG,
> + OV5648_TC21_BINNING_HORZ_EN,
> + mode->binning_x ? OV5648_TC21_BINNING_HORZ_EN :
> + 0);
> + if (ret)
> + return ret;
> +
> + ret = ov5648_write(sensor, OV5648_SUB_INC_X_REG,
> + OV5648_SUB_INC_X_ODD(mode->inc_x_odd) |
> + OV5648_SUB_INC_X_EVEN(mode->inc_x_even));
> + if (ret)
> + return ret;
> +
> + ret = ov5648_write(sensor, OV5648_SUB_INC_Y_REG,
> + OV5648_SUB_INC_Y_ODD(mode->inc_y_odd) |
> + OV5648_SUB_INC_Y_EVEN(mode->inc_y_even));
> + if (ret)
> + return ret;
> +
> + /* PLLs */
> +
> + ret = ov5648_mode_pll1_configure(sensor, mode, mbus_code);
> + if (ret)
> + return ret;
> +
> + ret = ov5648_mode_pll2_configure(sensor, mode);
> + if (ret)
> + return ret;
> +
> + /* Extra registers */
> +
> + if (mode->register_values) {
> + ret = ov5648_write_sequence(sensor, mode->register_values,
> + mode->register_values_count);
> + if (ret)
> + return ret;
> + }
> +
> + return 0;
> +}
> +
> +static unsigned long ov5648_mode_mipi_clk_rate(struct ov5648_sensor *sensor,
> + const struct ov5648_mode *mode,
> + u32 mbus_code)
> +{
> + const struct ov5648_pll1_config *config;
> + unsigned long pll1_rate;
> +
> + switch (mbus_code) {
> + case MEDIA_BUS_FMT_SBGGR8_1X8:
> + config = mode->pll1_config[0];
> + break;
> + case MEDIA_BUS_FMT_SBGGR10_1X10:
> + config = mode->pll1_config[1];
> + break;
> + default:
> + return 0;
> + }
> +
> + pll1_rate = ov5648_mode_pll1_rate(sensor, config);
> +
> + return pll1_rate / config->sys_div / config->mipi_div / 2;
> +}
> +
> +/* Exposure */
> +
> +static int ov5648_exposure_auto_configure(struct ov5648_sensor *sensor,
> + bool enable)
> +{
> + return ov5648_update_bits(sensor, OV5648_MANUAL_CTRL_REG,
> + OV5648_MANUAL_CTRL_AEC_MANUAL_EN,
> + enable ? 0 : OV5648_MANUAL_CTRL_AEC_MANUAL_EN);
> +}
> +
> +static int ov5648_exposure_configure(struct ov5648_sensor *sensor, u32 exposure)
> +{
> + struct ov5648_ctrls *ctrls = &sensor->ctrls;
> + int ret;
> +
> + if (ctrls->exposure_auto->val != V4L2_EXPOSURE_MANUAL)
> + return -EINVAL;
> +
> + ret = ov5648_write(sensor, OV5648_EXPOSURE_CTRL_HH_REG,
> + OV5648_EXPOSURE_CTRL_HH(exposure));
> + if (ret)
> + return ret;
> +
> + ret = ov5648_write(sensor, OV5648_EXPOSURE_CTRL_H_REG,
> + OV5648_EXPOSURE_CTRL_H(exposure));
> + if (ret)
> + return ret;
> +
> + return ov5648_write(sensor, OV5648_EXPOSURE_CTRL_L_REG,
> + OV5648_EXPOSURE_CTRL_L(exposure));
> +}
> +
> +static int ov5648_exposure_value(struct ov5648_sensor *sensor,
> + u32 *exposure)
> +{
> + u8 exposure_hh = 0, exposure_h = 0, exposure_l = 0;
> + int ret;
> +
> + ret = ov5648_read(sensor, OV5648_EXPOSURE_CTRL_HH_REG, &exposure_hh);
> + if (ret)
> + return ret;
> +
> + ret = ov5648_read(sensor, OV5648_EXPOSURE_CTRL_H_REG, &exposure_h);
> + if (ret)
> + return ret;
> +
> + ret = ov5648_read(sensor, OV5648_EXPOSURE_CTRL_L_REG, &exposure_l);
> + if (ret)
> + return ret;
> +
> + *exposure = OV5648_EXPOSURE_CTRL_HH_VALUE((u32)exposure_hh) |
> + OV5648_EXPOSURE_CTRL_H_VALUE((u32)exposure_h) |
> + OV5648_EXPOSURE_CTRL_L_VALUE((u32)exposure_l);
> +
> + return 0;
> +}
> +
> +/* Gain */
> +
> +static int ov5648_gain_auto_configure(struct ov5648_sensor *sensor, bool enable)
> +{
> + return ov5648_update_bits(sensor, OV5648_MANUAL_CTRL_REG,
> + OV5648_MANUAL_CTRL_AGC_MANUAL_EN,
> + enable ? 0 : OV5648_MANUAL_CTRL_AGC_MANUAL_EN);
> +}
> +
> +static int ov5648_gain_configure(struct ov5648_sensor *sensor, u32 gain)
> +{
> + struct ov5648_ctrls *ctrls = &sensor->ctrls;
> + int ret;
> +
> + if (ctrls->gain_auto->val)
> + return -EINVAL;
> +
> + ret = ov5648_write(sensor, OV5648_GAIN_CTRL_H_REG,
> + OV5648_GAIN_CTRL_H(gain));
> + if (ret)
> + return ret;
> +
> + return ov5648_write(sensor, OV5648_GAIN_CTRL_L_REG,
> + OV5648_GAIN_CTRL_L(gain));
> +}
> +
> +static int ov5648_gain_value(struct ov5648_sensor *sensor, u32 *gain)
> +{
> + u8 gain_h = 0, gain_l = 0;
> + int ret;
> +
> + ret = ov5648_read(sensor, OV5648_GAIN_CTRL_H_REG, &gain_h);
> + if (ret)
> + return ret;
> +
> + ret = ov5648_read(sensor, OV5648_GAIN_CTRL_L_REG, &gain_l);
> + if (ret)
> + return ret;
> +
> + *gain = OV5648_GAIN_CTRL_H_VALUE((u32)gain_h) |
> + OV5648_GAIN_CTRL_L_VALUE((u32)gain_l);
> +
> + return 0;
> +}
> +
> +/* White Balance */
> +
> +static int ov5648_white_balance_auto_configure(struct ov5648_sensor *sensor,
> + bool enable)
> +{
> + return ov5648_write(sensor, OV5648_AWB_CTRL_REG,
> + enable ? 0 : OV5648_AWB_CTRL_GAIN_MANUAL_EN);
> +}
> +
> +static int ov5648_white_balance_configure(struct ov5648_sensor *sensor,
> + u32 red_balance, u32 blue_balance)
> +{
> + struct ov5648_ctrls *ctrls = &sensor->ctrls;
> + int ret;
> +
> + if (ctrls->white_balance_auto->val)
> + return -EINVAL;
> +
> + ret = ov5648_write(sensor, OV5648_GAIN_RED_MAN_H_REG,
> + OV5648_GAIN_RED_MAN_H(red_balance));
> + if (ret)
> + return ret;
> +
> + ret = ov5648_write(sensor, OV5648_GAIN_RED_MAN_L_REG,
> + OV5648_GAIN_RED_MAN_L(red_balance));
> + if (ret)
> + return ret;
> +
> + ret = ov5648_write(sensor, OV5648_GAIN_BLUE_MAN_H_REG,
> + OV5648_GAIN_BLUE_MAN_H(blue_balance));
> + if (ret)
> + return ret;
> +
> + return ov5648_write(sensor, OV5648_GAIN_BLUE_MAN_L_REG,
> + OV5648_GAIN_BLUE_MAN_L(blue_balance));
> +}
> +
> +/* Flip */
> +
> +static int ov5648_flip_vert_configure(struct ov5648_sensor *sensor, bool enable)
> +{
> + u8 bits = OV5648_TC20_FLIP_VERT_ISP_EN |
> + OV5648_TC20_FLIP_VERT_SENSOR_EN;
> +
> + return ov5648_update_bits(sensor, OV5648_TC20_REG, bits,
> + enable ? bits : 0);
> +}
> +
> +static int ov5648_flip_horz_configure(struct ov5648_sensor *sensor, bool enable)
> +{
> + u8 bits = OV5648_TC21_FLIP_HORZ_ISP_EN |
> + OV5648_TC21_FLIP_HORZ_SENSOR_EN;
> +
> + return ov5648_update_bits(sensor, OV5648_TC21_REG, bits,
> + enable ? bits : 0);
> +}
> +
> +/* Test Pattern */
> +
> +static int ov5648_test_pattern_configure(struct ov5648_sensor *sensor,
> + unsigned int index)
> +{
> + if (index >= ARRAY_SIZE(ov5648_test_pattern_bits))
> + return -EINVAL;
> +
> + return ov5648_write(sensor, OV5648_ISP_CTRL3D_REG,
> + ov5648_test_pattern_bits[index]);
> +}
> +
> +/* State */
> +
> +static int ov5648_state_mipi_configure(struct ov5648_sensor *sensor,
> + const struct ov5648_mode *mode,
> + u32 mbus_code)
> +{
> + struct ov5648_ctrls *ctrls = &sensor->ctrls;
> + struct v4l2_fwnode_bus_mipi_csi2 *bus_mipi_csi2 =
> + &sensor->endpoint.bus.mipi_csi2;
> + unsigned long mipi_clk_rate;
> + unsigned int bits_per_sample;
> + unsigned int lanes_count;
> + unsigned int i, j;
> + s64 mipi_pixel_rate;
> +
> + mipi_clk_rate = ov5648_mode_mipi_clk_rate(sensor, mode, mbus_code);
> + if (!mipi_clk_rate)
> + return -EINVAL;
> +
> + for (i = 0; i < ARRAY_SIZE(ov5648_link_freq_menu); i++) {
> + s64 freq = ov5648_link_freq_menu[i];
> +
> + if (freq == mipi_clk_rate)
> + break;
> + }
> +
> + for (j = 0; j < sensor->endpoint.nr_of_link_frequencies; j++) {
> + u64 freq = sensor->endpoint.link_frequencies[j];
> +
> + if (freq == mipi_clk_rate)
> + break;
> + }
> +
> + if (i == ARRAY_SIZE(ov5648_link_freq_menu)) {
> + dev_err(sensor->dev,
> + "failed to find %lu clk rate in link freq\n",
> + mipi_clk_rate);
> + } else if (j == sensor->endpoint.nr_of_link_frequencies) {
> + dev_err(sensor->dev,
> + "failed to find %lu clk rate in endpoint link-frequencies\n",
> + mipi_clk_rate);
> + } else {
> + __v4l2_ctrl_s_ctrl(ctrls->link_freq, i);
> + }
> +
> + switch (mbus_code) {
> + case MEDIA_BUS_FMT_SBGGR8_1X8:
> + bits_per_sample = 8;
> + break;
> + case MEDIA_BUS_FMT_SBGGR10_1X10:
> + bits_per_sample = 10;
> + break;
> + default:
> + return -EINVAL;
> + }
> +
> + lanes_count = bus_mipi_csi2->num_data_lanes;
> + mipi_pixel_rate = mipi_clk_rate * 2 * lanes_count / bits_per_sample;
> +
> + __v4l2_ctrl_s_ctrl_int64(ctrls->pixel_rate, mipi_pixel_rate);
> +
> + return 0;
> +}
> +
> +static int ov5648_state_configure(struct ov5648_sensor *sensor,
> + const struct ov5648_mode *mode,
> + u32 mbus_code)
> +{
> + int ret;
> +
> + if (sensor->state.streaming)
> + return -EBUSY;
> +
> + /* State will be configured at first power on otherwise. */
> + if (pm_runtime_enabled(sensor->dev) &&
> + !pm_runtime_suspended(sensor->dev)) {
> + ret = ov5648_mode_configure(sensor, mode, mbus_code);
> + if (ret)
> + return ret;
> + }
> +
> + ret = ov5648_state_mipi_configure(sensor, mode, mbus_code);
> + if (ret)
> + return ret;
> +
> + sensor->state.mode = mode;
> + sensor->state.mbus_code = mbus_code;
> +
> + return 0;
> +}
> +
> +static int ov5648_state_init(struct ov5648_sensor *sensor)
> +{
> + return ov5648_state_configure(sensor, &ov5648_modes[0],
> + ov5648_mbus_codes[0]);
> +}
> +
> +/* Sensor Base */
> +
> +static int ov5648_sensor_init(struct ov5648_sensor *sensor)
> +{
> + int ret;
> +
> + ret = ov5648_sw_reset(sensor);
> + if (ret) {
> + dev_err(sensor->dev, "failed to perform sw reset\n");
> + return ret;
> + }
> +
> + ret = ov5648_sw_standby(sensor, 1);
> + if (ret) {
> + dev_err(sensor->dev, "failed to set sensor standby\n");
> + return ret;
> + }
> +
> + ret = ov5648_chip_id_check(sensor);
> + if (ret) {
> + dev_err(sensor->dev, "failed to check sensor chip id\n");
> + return ret;
> + }
> +
> + ret = ov5648_avdd_internal_power(sensor, !sensor->avdd);
> + if (ret) {
> + dev_err(sensor->dev, "failed to set internal avdd power\n");
> + return ret;
> + }
> +
> + ret = ov5648_write_sequence(sensor, ov5648_init_sequence,
> + ARRAY_SIZE(ov5648_init_sequence));
> + if (ret) {
> + dev_err(sensor->dev, "failed to write init sequence\n");
> + return ret;
> + }
> +
> + ret = ov5648_pad_configure(sensor);
> + if (ret) {
> + dev_err(sensor->dev, "failed to configure pad\n");
> + return ret;
> + }
> +
> + ret = ov5648_mipi_configure(sensor);
> + if (ret) {
> + dev_err(sensor->dev, "failed to configure MIPI\n");
> + return ret;
> + }
> +
> + ret = ov5648_isp_configure(sensor);
> + if (ret) {
> + dev_err(sensor->dev, "failed to configure ISP\n");
> + return ret;
> + }
> +
> + ret = ov5648_black_level_configure(sensor);
> + if (ret) {
> + dev_err(sensor->dev, "failed to configure black level\n");
> + return ret;
> + }
> +
> + /* Configure current mode. */
> + ret = ov5648_state_configure(sensor, sensor->state.mode,
> + sensor->state.mbus_code);
> + if (ret) {
> + dev_err(sensor->dev, "failed to configure state\n");
> + return ret;
> + }
> +
> + return 0;
> +}
> +
> +static int ov5648_sensor_power(struct ov5648_sensor *sensor, bool on)
> +{
> + /* Keep initialized to zero for disable label. */
> + int ret = 0;
> +
> + /*
> + * General notes about the power sequence:
> + * - power-down GPIO must be active (low) during power-on;
> + * - reset GPIO state does not matter during power-on;
> + * - XVCLK must be provided 1 ms before register access;
> + * - 10 ms are needed between power-down deassert and register access.
> + */
> +
> + /* Note that regulator-and-GPIO-based power is untested. */
> + if (on) {
> + gpiod_set_value_cansleep(sensor->reset, 1);
> + gpiod_set_value_cansleep(sensor->powerdown, 1);
> +
> + ret = regulator_enable(sensor->dovdd);
> + if (ret) {
> + dev_err(sensor->dev,
> + "failed to enable DOVDD regulator\n");
> + goto disable;
> + }
> +
> + if (sensor->avdd) {
> + ret = regulator_enable(sensor->avdd);
> + if (ret) {
> + dev_err(sensor->dev,
> + "failed to enable AVDD regulator\n");
> + goto disable;
> + }
> + }
> +
> + ret = regulator_enable(sensor->dvdd);
> + if (ret) {
> + dev_err(sensor->dev,
> + "failed to enable DVDD regulator\n");
> + goto disable;
> + }
> +
> + /* According to OV5648 power up diagram. */
> + usleep_range(5000, 10000);
> +
> + ret = clk_prepare_enable(sensor->xvclk);
> + if (ret) {
> + dev_err(sensor->dev, "failed to enable XVCLK clock\n");
> + goto disable;
> + }
> +
> + gpiod_set_value_cansleep(sensor->reset, 0);
> + gpiod_set_value_cansleep(sensor->powerdown, 0);
> +
> + usleep_range(20000, 25000);
> + } else {
> +disable:
> + gpiod_set_value_cansleep(sensor->powerdown, 1);
> + gpiod_set_value_cansleep(sensor->reset, 1);
> +
> + clk_disable_unprepare(sensor->xvclk);
> +
> + regulator_disable(sensor->dvdd);
> +
> + if (sensor->avdd)
> + regulator_disable(sensor->avdd);
> +
> + regulator_disable(sensor->dovdd);
> + }
> +
> + return ret;
> +}
> +
> +/* Controls */
> +
> +static int ov5648_g_volatile_ctrl(struct v4l2_ctrl *ctrl)
> +{
> + struct v4l2_subdev *subdev = ov5648_ctrl_subdev(ctrl);
> + struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
> + struct ov5648_ctrls *ctrls = &sensor->ctrls;
> + int ret;
> +
> + switch (ctrl->id) {
> + case V4L2_CID_EXPOSURE_AUTO:
> + ret = ov5648_exposure_value(sensor, &ctrls->exposure->val);
> + if (ret)
> + return ret;
> + break;
> + case V4L2_CID_AUTOGAIN:
> + ret = ov5648_gain_value(sensor, &ctrls->gain->val);
> + if (ret)
> + return ret;
> + break;
> + default:
> + return -EINVAL;
> + }
> +
> + return 0;
> +}
> +
> +static int ov5648_s_ctrl(struct v4l2_ctrl *ctrl)
> +{
> + struct v4l2_subdev *subdev = ov5648_ctrl_subdev(ctrl);
> + struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
> + struct ov5648_ctrls *ctrls = &sensor->ctrls;
> + unsigned int index;
> + bool enable;
> + int ret;
> +
> + /* Wait for the sensor to be on before setting controls. */
> + if (pm_runtime_suspended(sensor->dev))
> + return 0;
> +
> + switch (ctrl->id) {
> + case V4L2_CID_EXPOSURE_AUTO:
> + enable = ctrl->val == V4L2_EXPOSURE_AUTO;
> +
> + ret = ov5648_exposure_auto_configure(sensor, enable);
> + if (ret)
> + return ret;
> +
> + if (!enable && ctrls->exposure->is_new) {
> + ret = ov5648_exposure_configure(sensor,
> + ctrls->exposure->val);
> + if (ret)
> + return ret;
> + }
> + break;
> + case V4L2_CID_AUTOGAIN:
> + enable = !!ctrl->val;
> +
> + ret = ov5648_gain_auto_configure(sensor, enable);
> + if (ret)
> + return ret;
> +
> + if (!enable) {
> + ret = ov5648_gain_configure(sensor, ctrls->gain->val);
> + if (ret)
> + return ret;
> + }
> + break;
> + case V4L2_CID_AUTO_WHITE_BALANCE:
> + enable = !!ctrl->val;
> +
> + ret = ov5648_white_balance_auto_configure(sensor, enable);
> + if (ret)
> + return ret;
> +
> + if (!enable) {
> + ret = ov5648_white_balance_configure(sensor,
> + ctrls->red_balance->val,
> + ctrls->blue_balance->val);
> + if (ret)
> + return ret;
> + }
> + break;
> + case V4L2_CID_HFLIP:
> + enable = !!ctrl->val;
> + return ov5648_flip_horz_configure(sensor, enable);
> + case V4L2_CID_VFLIP:
> + enable = !!ctrl->val;
> + return ov5648_flip_vert_configure(sensor, enable);
> + case V4L2_CID_TEST_PATTERN:
> + index = (unsigned int)ctrl->val;
> + return ov5648_test_pattern_configure(sensor, index);
> + default:
> + return -EINVAL;
> + }
> +
> + return 0;
> +}
> +
> +static const struct v4l2_ctrl_ops ov5648_ctrl_ops = {
> + .g_volatile_ctrl = ov5648_g_volatile_ctrl,
> + .s_ctrl = ov5648_s_ctrl,
> +};
> +
> +static int ov5648_ctrls_init(struct ov5648_sensor *sensor)
> +{
> + struct ov5648_ctrls *ctrls = &sensor->ctrls;
> + struct v4l2_ctrl_handler *handler = &ctrls->handler;
> + const struct v4l2_ctrl_ops *ops = &ov5648_ctrl_ops;
> + int ret;
> +
> + v4l2_ctrl_handler_init(handler, 32);
> +
> + /* Use our mutex for ctrl locking. */
> + handler->lock = &sensor->mutex;
> +
> + /* Exposure */
> +
> + ctrls->exposure_auto = v4l2_ctrl_new_std_menu(handler, ops,
> + V4L2_CID_EXPOSURE_AUTO,
> + V4L2_EXPOSURE_MANUAL, 0,
> + V4L2_EXPOSURE_AUTO);
> +
> + ctrls->exposure = v4l2_ctrl_new_std(handler, ops, V4L2_CID_EXPOSURE,
> + 16, 1048575, 16, 512);
> + ctrls->exposure->flags |= V4L2_CTRL_FLAG_VOLATILE;
ctrls->exposure may be NULL here.
I'd move this after the handler's error check.
> +
> + v4l2_ctrl_auto_cluster(2, &ctrls->exposure_auto, 1, true);
> +
> + /* Gain */
> +
> + ctrls->gain_auto =
> + v4l2_ctrl_new_std(handler, ops, V4L2_CID_AUTOGAIN, 0, 1, 1, 1);
> +
> + ctrls->gain = v4l2_ctrl_new_std(handler, ops, V4L2_CID_GAIN, 16, 1023,
> + 16, 16);
> + ctrls->gain->flags |= V4L2_CTRL_FLAG_VOLATILE;
Ditto.
> +
> + v4l2_ctrl_auto_cluster(2, &ctrls->gain_auto, 0, true);
> +
> + /* White Balance */
> +
> + ctrls->white_balance_auto =
> + v4l2_ctrl_new_std(handler, ops, V4L2_CID_AUTO_WHITE_BALANCE, 0,
> + 1, 1, 1);
> +
> + ctrls->red_balance = v4l2_ctrl_new_std(handler, ops,
> + V4L2_CID_RED_BALANCE, 0, 4095,
> + 1, 1024);
> +
> + ctrls->blue_balance = v4l2_ctrl_new_std(handler, ops,
> + V4L2_CID_BLUE_BALANCE, 0, 4095,
> + 1, 1024);
> +
> + v4l2_ctrl_auto_cluster(3, &ctrls->white_balance_auto, 0, false);
> +
> + /* Flip */
> +
> + v4l2_ctrl_new_std(handler, ops, V4L2_CID_HFLIP, 0, 1, 1, 0);
> + v4l2_ctrl_new_std(handler, ops, V4L2_CID_VFLIP, 0, 1, 1, 0);
> +
> + /* Test Pattern */
> +
> + v4l2_ctrl_new_std_menu_items(handler, ops, V4L2_CID_TEST_PATTERN,
> + ARRAY_SIZE(ov5648_test_pattern_menu) - 1,
> + 0, 0, ov5648_test_pattern_menu);
> +
> + /* MIPI CSI-2 */
> +
> + ctrls->link_freq =
> + v4l2_ctrl_new_int_menu(handler, NULL, V4L2_CID_LINK_FREQ,
> + ARRAY_SIZE(ov5648_link_freq_menu) - 1,
> + 0, ov5648_link_freq_menu);
> +
> + ctrls->link_freq->flags |= V4L2_CTRL_FLAG_READ_ONLY;
Ditto.
> +
> + ctrls->pixel_rate =
> + v4l2_ctrl_new_std(handler, NULL, V4L2_CID_PIXEL_RATE, 1,
> + INT_MAX, 1, 1);
> +
> + ctrls->pixel_rate->flags |= V4L2_CTRL_FLAG_READ_ONLY;
Ditto.
> +
> + if (handler->error) {
> + ret = handler->error;
> + goto error_ctrls;
> + }
> +
> + sensor->subdev.ctrl_handler = handler;
> +
> + return 0;
> +
> +error_ctrls:
> + v4l2_ctrl_handler_free(handler);
> +
> + return ret;
> +}
> +
> +/* Subdev Video Operations */
> +
> +static int ov5648_s_stream(struct v4l2_subdev *subdev, int enable)
> +{
> + struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
> + struct ov5648_state *state = &sensor->state;
> + int ret = 0;
No need to initialise ret.
> +
> + if (enable) {
> + ret = pm_runtime_get_sync(sensor->dev);
> + if (ret < 0) {
> + pm_runtime_put_noidle(sensor->dev);
> + return ret;
> + }
> + }
> +
> + mutex_lock(&sensor->mutex);
> + ret = ov5648_sw_standby(sensor, !enable);
> + mutex_unlock(&sensor->mutex);
> +
> + if (ret)
> + return ret;
> +
> + state->streaming = !!enable;
> +
> + if (!enable)
> + pm_runtime_put(sensor->dev);
> +
> + return 0;
> +}
> +
> +static int ov5648_g_frame_interval(struct v4l2_subdev *subdev,
> + struct v4l2_subdev_frame_interval *interval)
> +{
> + struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
> + const struct ov5648_mode *mode;
> + int ret = 0;
> +
> + mutex_lock(&sensor->mutex);
> +
> + mode = sensor->state.mode;
> +
> + switch (sensor->state.mbus_code) {
> + case MEDIA_BUS_FMT_SBGGR8_1X8:
> + interval->interval = mode->frame_interval[0];
> + break;
> + case MEDIA_BUS_FMT_SBGGR10_1X10:
> + interval->interval = mode->frame_interval[1];
> + break;
> + default:
> + ret = -EINVAL;
> + }
> +
> + mutex_unlock(&sensor->mutex);
> +
> + return ret;
> +}
> +
> +static const struct v4l2_subdev_video_ops ov5648_subdev_video_ops = {
> + .s_stream = ov5648_s_stream,
> + .g_frame_interval = ov5648_g_frame_interval,
> + .s_frame_interval = ov5648_g_frame_interval,
> +};
> +
> +/* Subdev Pad Operations */
> +
> +static int ov5648_enum_mbus_code(struct v4l2_subdev *subdev,
> + struct v4l2_subdev_pad_config *config,
> + struct v4l2_subdev_mbus_code_enum *code_enum)
> +{
> + if (code_enum->index >= ARRAY_SIZE(ov5648_mbus_codes))
> + return -EINVAL;
> +
> + code_enum->code = ov5648_mbus_codes[code_enum->index];
> +
> + return 0;
> +}
> +
> +static void ov5648_mbus_format_fill(struct v4l2_mbus_framefmt *mbus_format,
> + u32 mbus_code,
> + const struct ov5648_mode *mode)
> +{
> + mbus_format->width = mode->output_size_x;
> + mbus_format->height = mode->output_size_y;
> + mbus_format->code = mbus_code;
> +
> + mbus_format->field = V4L2_FIELD_NONE;
> + mbus_format->colorspace = V4L2_COLORSPACE_RAW;
> + mbus_format->ycbcr_enc =
> + V4L2_MAP_YCBCR_ENC_DEFAULT(mbus_format->colorspace);
> + mbus_format->quantization = V4L2_QUANTIZATION_FULL_RANGE;
> + mbus_format->xfer_func =
> + V4L2_MAP_XFER_FUNC_DEFAULT(mbus_format->colorspace);
> +}
> +
> +static int ov5648_get_fmt(struct v4l2_subdev *subdev,
> + struct v4l2_subdev_pad_config *config,
> + struct v4l2_subdev_format *format)
> +{
> + struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
> + struct v4l2_mbus_framefmt *mbus_format = &format->format;
> +
> + mutex_lock(&sensor->mutex);
> +
> + if (format->which == V4L2_SUBDEV_FORMAT_TRY)
> + *mbus_format = *v4l2_subdev_get_try_format(subdev, config,
> + format->pad);
> + else
> + ov5648_mbus_format_fill(mbus_format, sensor->state.mbus_code,
> + sensor->state.mode);
> +
> + mutex_unlock(&sensor->mutex);
> +
> + return 0;
> +}
> +
> +static int ov5648_set_fmt(struct v4l2_subdev *subdev,
> + struct v4l2_subdev_pad_config *config,
> + struct v4l2_subdev_format *format)
> +{
> + struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
> + struct v4l2_mbus_framefmt *mbus_format = &format->format;
> + const struct ov5648_mode *mode;
> + u32 mbus_code = 0;
> + unsigned int index;
> + int ret = 0;
> +
> + mutex_lock(&sensor->mutex);
> +
> + if (sensor->state.streaming) {
> + ret = -EBUSY;
> + goto complete;
> + }
> +
> + /* Try to find requested mbus code. */
> + for (index = 0; index < ARRAY_SIZE(ov5648_mbus_codes); index++) {
> + if (ov5648_mbus_codes[index] == mbus_format->code) {
> + mbus_code = mbus_format->code;
> + break;
> + }
> + }
> +
> + /* Fallback to default. */
> + if (!mbus_code)
> + mbus_code = ov5648_mbus_codes[0];
> +
> + /* Find the mode with nearest dimensions. */
> + mode = v4l2_find_nearest_size(ov5648_modes, ARRAY_SIZE(ov5648_modes),
> + output_size_x, output_size_y,
> + mbus_format->width, mbus_format->height);
> + if (!mode)
mutex is held here.
> + return -EINVAL;
> +
> + ov5648_mbus_format_fill(mbus_format, mbus_code, mode);
> +
> + if (format->which == V4L2_SUBDEV_FORMAT_TRY) {
> + *v4l2_subdev_get_try_format(subdev, config, format->pad) =
> + *mbus_format;
> + } else if (sensor->state.mode != mode ||
> + sensor->state.mbus_code != mbus_code) {
> + ret = ov5648_state_configure(sensor, mode, mbus_code);
> + if (ret)
> + goto complete;
The goto has no effect here.
> + }
> +
> +complete:
> + mutex_unlock(&sensor->mutex);
> +
> + return ret;
> +}
> +
> +static int ov5648_enum_frame_size(struct v4l2_subdev *subdev,
> + struct v4l2_subdev_pad_config *config,
> + struct v4l2_subdev_frame_size_enum *size_enum)
> +{
> + const struct ov5648_mode *mode;
> +
> + if (size_enum->index >= ARRAY_SIZE(ov5648_modes))
> + return -EINVAL;
> +
> + mode = &ov5648_modes[size_enum->index];
> +
> + size_enum->min_width = size_enum->max_width = mode->output_size_x;
> + size_enum->min_height = size_enum->max_height = mode->output_size_y;
> +
> + return 0;
> +}
> +
> +static int ov5648_enum_frame_interval(struct v4l2_subdev *subdev,
> + struct v4l2_subdev_pad_config *config,
> + struct v4l2_subdev_frame_interval_enum *interval_enum)
> +{
> + const struct ov5648_mode *mode = NULL;
> + unsigned int mode_index;
> + unsigned int interval_index;
> +
> + if (interval_enum->index > 0)
> + return -EINVAL;
> +
> + /*
> + * Multiple modes with the same dimensions may have different frame
> + * intervals, so look up each relevant mode.
> + */
> + for (mode_index = 0, interval_index = 0;
> + mode_index < ARRAY_SIZE(ov5648_modes); mode_index++) {
> + mode = &ov5648_modes[mode_index];
> +
> + if (mode->output_size_x == interval_enum->width &&
> + mode->output_size_y == interval_enum->height) {
> + if (interval_index == interval_enum->index)
> + break;
> +
> + interval_index++;
> + }
> + }
> +
> + if (mode_index == ARRAY_SIZE(ov5648_modes) || !mode)
> + return -EINVAL;
> +
> + switch (interval_enum->code) {
> + case MEDIA_BUS_FMT_SBGGR8_1X8:
> + interval_enum->interval = mode->frame_interval[0];
> + break;
> + case MEDIA_BUS_FMT_SBGGR10_1X10:
> + interval_enum->interval = mode->frame_interval[1];
> + break;
> + default:
> + return -EINVAL;
> + }
> +
> + return 0;
> +}
> +
> +static const struct v4l2_subdev_pad_ops ov5648_subdev_pad_ops = {
> + .enum_mbus_code = ov5648_enum_mbus_code,
> + .get_fmt = ov5648_get_fmt,
> + .set_fmt = ov5648_set_fmt,
> + .enum_frame_size = ov5648_enum_frame_size,
> + .enum_frame_interval = ov5648_enum_frame_interval,
> +};
> +
> +static const struct v4l2_subdev_ops ov5648_subdev_ops = {
> + .video = &ov5648_subdev_video_ops,
> + .pad = &ov5648_subdev_pad_ops,
> +};
> +
> +static int ov5648_suspend(struct device *dev)
> +{
> + struct i2c_client *client = to_i2c_client(dev);
> + struct v4l2_subdev *subdev = i2c_get_clientdata(client);
> + struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
> + struct ov5648_state *state = &sensor->state;
> + int ret = 0;
> +
> + mutex_lock(&sensor->mutex);
> +
> + if (state->streaming) {
> + ret = ov5648_sw_standby(sensor, true);
> + if (ret)
> + goto complete;
> + }
> +
> + ret = ov5648_sensor_power(sensor, false);
> + if (ret) {
> + ov5648_sw_standby(sensor, false);
> + goto complete;
No need for goto.
> + }
> +
> +complete:
> + mutex_unlock(&sensor->mutex);
> +
> + return ret;
> +}
> +
> +static int ov5648_resume(struct device *dev)
> +{
> + struct i2c_client *client = to_i2c_client(dev);
> + struct v4l2_subdev *subdev = i2c_get_clientdata(client);
> + struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
> + struct ov5648_state *state = &sensor->state;
> + int ret = 0;
> +
> + mutex_lock(&sensor->mutex);
> +
> + ret = ov5648_sensor_power(sensor, true);
> + if (ret)
> + goto complete;
> +
> + ret = ov5648_sensor_init(sensor);
> + if (ret)
> + goto error_power;
> +
> + ret = __v4l2_ctrl_handler_setup(&sensor->ctrls.handler);
> + if (ret)
> + goto error_power;
> +
> + if (state->streaming) {
> + ret = ov5648_sw_standby(sensor, false);
> + if (ret)
> + goto error_power;
> + }
> +
> + goto complete;
This isn't really wrong, but the code might be easier to read if you
unlocked the mutex here and returned zero.
> +
> +error_power:
> + ov5648_sensor_power(sensor, false);
> +
> +complete:
> + mutex_unlock(&sensor->mutex);
> +
> + return ret;
> +}
> +
> +static int ov5648_probe(struct i2c_client *client)
> +{
> + struct device *dev = &client->dev;
> + struct fwnode_handle *handle;
> + struct ov5648_sensor *sensor;
> + struct v4l2_subdev *subdev;
> + struct media_pad *pad;
> + unsigned long rate;
> + int ret;
> +
> + sensor = devm_kzalloc(dev, sizeof(*sensor), GFP_KERNEL);
> + if (!sensor)
> + return -ENOMEM;
> +
> + sensor->dev = dev;
> + sensor->i2c_client = client;
> +
> + /* Graph Endpoint */
> +
> + handle = fwnode_graph_get_next_endpoint(dev_fwnode(dev), NULL);
> + if (!handle) {
> + dev_err(dev, "unable to find enpoint node\n");
> + return -EINVAL;
> + }
> +
> + sensor->endpoint.bus_type = V4L2_MBUS_CSI2_DPHY;
> +
> + ret = v4l2_fwnode_endpoint_alloc_parse(handle, &sensor->endpoint);
> + fwnode_handle_put(handle);
> + if (ret) {
> + dev_err(dev, "failed to parse endpoint node\n");
> + return ret;
> + }
> +
> + /* GPIOs */
> +
> + sensor->powerdown = devm_gpiod_get_optional(dev, "powerdown",
> + GPIOD_OUT_HIGH);
> + if (IS_ERR(sensor->powerdown)) {
> + ret = PTR_ERR(sensor->powerdown);
> + goto error_endpoint;
> + }
> +
> + sensor->reset = devm_gpiod_get_optional(dev, "reset", GPIOD_OUT_HIGH);
> + if (IS_ERR(sensor->reset)) {
> + ret = PTR_ERR(sensor->reset);
> + goto error_endpoint;
> + }
> +
> + /* Regulators */
> +
> + /* DVDD: digital core */
> + sensor->dvdd = devm_regulator_get(dev, "dvdd");
> + if (IS_ERR(sensor->dvdd)) {
> + dev_err(dev, "cannot get DVDD (digital core) regulator\n");
> + ret = PTR_ERR(sensor->dvdd);
> + goto error_endpoint;
> + }
> +
> + /* DOVDD: digital I/O */
> + sensor->dovdd = devm_regulator_get(dev, "dovdd");
> + if (IS_ERR(sensor->dvdd)) {
> + dev_err(dev, "cannot get DOVDD (digital I/O) regulator\n");
> + ret = PTR_ERR(sensor->dvdd);
> + goto error_endpoint;
> + }
> +
> + /* AVDD: analog */
> + sensor->avdd = devm_regulator_get_optional(dev, "avdd");
> + if (IS_ERR(sensor->avdd)) {
> + dev_info(dev, "no AVDD regulator provided, using internal\n");
> + sensor->avdd = NULL;
> + }
> +
> + /* External Clock */
> +
> + sensor->xvclk = devm_clk_get(dev, NULL);
> + if (IS_ERR(sensor->xvclk)) {
> + dev_err(dev, "failed to get external clock\n");
> + ret = PTR_ERR(sensor->xvclk);
> + goto error_endpoint;
> + }
> +
> + rate = clk_get_rate(sensor->xvclk);
> + if (rate != OV5648_XVCLK_RATE) {
> + dev_err(dev, "clock rate %lu Hz is unsupported\n", rate);
> + ret = -EINVAL;
> + goto error_endpoint;
> + }
> +
> + /* Subdev, entity and pad */
> +
> + subdev = &sensor->subdev;
> + v4l2_i2c_subdev_init(subdev, client, &ov5648_subdev_ops);
> +
> + subdev->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
> + subdev->entity.function = MEDIA_ENT_F_CAM_SENSOR;
> +
> + pad = &sensor->pad;
> + pad->flags = MEDIA_PAD_FL_SOURCE;
> +
> + ret = media_entity_pads_init(&subdev->entity, 1, pad);
> + if (ret)
> + goto error_entity;
> +
> + /* Mutex */
> +
> + mutex_init(&sensor->mutex);
> +
> + /* Sensor */
> +
> + ret = ov5648_ctrls_init(sensor);
> + if (ret)
> + goto error_mutex;
> +
> + ret = ov5648_state_init(sensor);
> + if (ret)
> + goto error_ctrls;
> +
> + /* Runtime PM */
> +
> + pm_runtime_enable(sensor->dev);
> + pm_runtime_set_suspended(sensor->dev);
> +
> + /* V4L2 subdev register */
> +
> + ret = v4l2_async_register_subdev_sensor_common(subdev);
> + if (ret)
> + goto error_pm;
> +
> + return 0;
> +
> +error_pm:
> + pm_runtime_disable(sensor->dev);
> +
> +error_ctrls:
> + v4l2_ctrl_handler_free(&sensor->ctrls.handler);
> +
> +error_mutex:
> + mutex_destroy(&sensor->mutex);
> +
> +error_entity:
> + media_entity_cleanup(&sensor->subdev.entity);
> +
> +error_endpoint:
> + v4l2_fwnode_endpoint_free(&sensor->endpoint);
> +
> + return ret;
> +}
> +
> +static int ov5648_remove(struct i2c_client *client)
> +{
> + struct v4l2_subdev *subdev = i2c_get_clientdata(client);
> + struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
> +
> + v4l2_async_unregister_subdev(subdev);
> + pm_runtime_disable(sensor->dev);
> + v4l2_ctrl_handler_free(&sensor->ctrls.handler);
> + mutex_destroy(&sensor->mutex);
> + media_entity_cleanup(&subdev->entity);
> + v4l2_device_unregister_subdev(subdev);
This needs to be done only for subdevs registered using
v4l2_device_register_subdev(), i.e. not here.
> +
> + return 0;
> +}
> +
> +static const struct dev_pm_ops ov5648_pm_ops = {
> + SET_RUNTIME_PM_OPS(ov5648_suspend, ov5648_resume, NULL)
> +};
> +
> +static const struct of_device_id ov5648_of_match[] = {
> + { .compatible = "ovti,ov5648" },
> + { }
> +};
> +MODULE_DEVICE_TABLE(of, ov5648_of_match);
> +
> +static struct i2c_driver ov5648_driver = {
> + .driver = {
> + .name = "ov5648",
> + .of_match_table = ov5648_of_match,
> + .pm = &ov5648_pm_ops,
> + },
> + .probe_new = ov5648_probe,
> + .remove = ov5648_remove,
> +};
> +
> +module_i2c_driver(ov5648_driver);
> +
> +MODULE_AUTHOR("Paul Kocialkowski <paul.kocialkowski@bootlin.com>");
> +MODULE_DESCRIPTION("V4L2 driver for the OmniVision OV5648 image sensor");
> +MODULE_LICENSE("GPL v2");
--
Kind regards,
Sakari Ailus
^ permalink raw reply [flat|nested] 5+ messages in thread
* Re: [PATCH v5 2/2] media: i2c: Add support for the OV5648 image sensor
2020-12-20 22:39 ` Sakari Ailus
@ 2020-12-31 12:53 ` Paul Kocialkowski
0 siblings, 0 replies; 5+ messages in thread
From: Paul Kocialkowski @ 2020-12-31 12:53 UTC (permalink / raw)
To: Sakari Ailus
Cc: linux-media, devicetree, linux-kernel, linux-arm-kernel,
Mauro Carvalho Chehab, Rob Herring, Maxime Ripard, Hans Verkuil,
Thomas Petazzoni
[-- Attachment #1: Type: text/plain, Size: 87248 bytes --]
Hi Sakari,
On Mon 21 Dec 20, 00:39, Sakari Ailus wrote:
> Hi Paul,
>
> Thanks for the update.
>
> A few more small issues below that I didn't notice earlier. The comments
> apply to the other driver as well I believe.
Thanks for the review, I'll address your comments in the next version for
both drivers!
Cheers,
Paul
> On Fri, Dec 11, 2020 at 04:40:27PM +0100, Paul Kocialkowski wrote:
> > The OV5648 is a 5 Mpx CMOS image sensor, connected via MIPI CSI-2
> > in a one or two lane configuration.
> >
> > Most of the features of the hardware are supported, including:
> > - Auto and manual exposition/gain
> > - Auto and manual white balance
> > - Horizontal and vertical flip
> > - Test patterns
> >
> > But the following are still missing:
> > - Debanding, based on power source frequency;
> > - Exposition setting correlated to time units.
> >
> > Signed-off-by: Paul Kocialkowski <paul.kocialkowski@bootlin.com>
> > ---
> > drivers/media/i2c/Kconfig | 13 +
> > drivers/media/i2c/Makefile | 1 +
> > drivers/media/i2c/ov5648.c | 2638 ++++++++++++++++++++++++++++++++++++
> > 3 files changed, 2652 insertions(+)
> > create mode 100644 drivers/media/i2c/ov5648.c
> >
> > diff --git a/drivers/media/i2c/Kconfig b/drivers/media/i2c/Kconfig
> > index 878f66ef2719..c0470a8b9a80 100644
> > --- a/drivers/media/i2c/Kconfig
> > +++ b/drivers/media/i2c/Kconfig
> > @@ -922,6 +922,19 @@ config VIDEO_OV5647
> > To compile this driver as a module, choose M here: the
> > module will be called ov5647.
> >
> > +config VIDEO_OV5648
> > + tristate "OmniVision OV5648 sensor support"
> > + depends on I2C && PM && VIDEO_V4L2
> > + select MEDIA_CONTROLLER
> > + select VIDEO_V4L2_SUBDEV_API
> > + select V4L2_FWNODE
> > + help
> > + This is a Video4Linux2 sensor driver for the OmniVision
> > + OV5648 camera.
> > +
> > + To compile this driver as a module, choose M here: the
> > + module will be called ov5648.
> > +
> > config VIDEO_OV6650
> > tristate "OmniVision OV6650 sensor support"
> > depends on I2C && VIDEO_V4L2
> > diff --git a/drivers/media/i2c/Makefile b/drivers/media/i2c/Makefile
> > index f0a77473979d..15d4d6382582 100644
> > --- a/drivers/media/i2c/Makefile
> > +++ b/drivers/media/i2c/Makefile
> > @@ -71,6 +71,7 @@ obj-$(CONFIG_VIDEO_OV2740) += ov2740.o
> > obj-$(CONFIG_VIDEO_OV5640) += ov5640.o
> > obj-$(CONFIG_VIDEO_OV5645) += ov5645.o
> > obj-$(CONFIG_VIDEO_OV5647) += ov5647.o
> > +obj-$(CONFIG_VIDEO_OV5648) += ov5648.o
> > obj-$(CONFIG_VIDEO_OV5670) += ov5670.o
> > obj-$(CONFIG_VIDEO_OV5675) += ov5675.o
> > obj-$(CONFIG_VIDEO_OV5695) += ov5695.o
> > diff --git a/drivers/media/i2c/ov5648.c b/drivers/media/i2c/ov5648.c
> > new file mode 100644
> > index 000000000000..4ae6b65ec258
> > --- /dev/null
> > +++ b/drivers/media/i2c/ov5648.c
> > @@ -0,0 +1,2638 @@
> > +// SPDX-License-Identifier: GPL-2.0-or-later
> > +/*
> > + * Copyright (C) 2020 Bootlin
> > + * Author: Paul Kocialkowski <paul.kocialkowski@bootlin.com>
> > + */
> > +
> > +#include <linux/clk.h>
> > +#include <linux/delay.h>
> > +#include <linux/device.h>
> > +#include <linux/i2c.h>
> > +#include <linux/module.h>
> > +#include <linux/of_graph.h>
> > +#include <linux/pm_runtime.h>
> > +#include <linux/regulator/consumer.h>
> > +#include <linux/videodev2.h>
> > +#include <media/v4l2-ctrls.h>
> > +#include <media/v4l2-device.h>
> > +#include <media/v4l2-fwnode.h>
> > +#include <media/v4l2-image-sizes.h>
> > +#include <media/v4l2-mediabus.h>
> > +
> > +/* Clock rate */
> > +
> > +#define OV5648_XVCLK_RATE 24000000
> > +
> > +/* Register definitions */
> > +
> > +/* System */
> > +
> > +#define OV5648_SW_STANDBY_REG 0x100
> > +#define OV5648_SW_STANDBY_STREAM_ON BIT(0)
> > +
> > +#define OV5648_SW_RESET_REG 0x103
> > +#define OV5648_SW_RESET_RESET BIT(0)
> > +
> > +#define OV5648_PAD_OEN0_REG 0x3000
> > +#define OV5648_PAD_OEN1_REG 0x3001
> > +#define OV5648_PAD_OEN2_REG 0x3002
> > +#define OV5648_PAD_OUT0_REG 0x3008
> > +#define OV5648_PAD_OUT1_REG 0x3009
> > +
> > +#define OV5648_CHIP_ID_H_REG 0x300a
> > +#define OV5648_CHIP_ID_H_VALUE 0x56
> > +#define OV5648_CHIP_ID_L_REG 0x300b
> > +#define OV5648_CHIP_ID_L_VALUE 0x48
> > +
> > +#define OV5648_PAD_OUT2_REG 0x300d
> > +#define OV5648_PAD_SEL0_REG 0x300e
> > +#define OV5648_PAD_SEL1_REG 0x300f
> > +#define OV5648_PAD_SEL2_REG 0x3010
> > +#define OV5648_PAD_PK_REG 0x3011
> > +#define OV5648_PAD_PK_PD_DATO_EN BIT(7)
> > +#define OV5648_PAD_PK_DRIVE_STRENGTH_1X (0 << 5)
> > +#define OV5648_PAD_PK_DRIVE_STRENGTH_2X (2 << 5)
> > +#define OV5648_PAD_PK_FREX_N BIT(1)
> > +
> > +#define OV5648_A_PWC_PK_O0_REG 0x3013
> > +#define OV5648_A_PWC_PK_O0_BP_REGULATOR_N BIT(3)
> > +#define OV5648_A_PWC_PK_O1_REG 0x3014
> > +
> > +#define OV5648_MIPI_PHY0_REG 0x3016
> > +#define OV5648_MIPI_PHY1_REG 0x3017
> > +#define OV5648_MIPI_SC_CTRL0_REG 0x3018
> > +#define OV5648_MIPI_SC_CTRL0_MIPI_LANES(v) (((v) << 5) & GENMASK(7, 5))
> > +#define OV5648_MIPI_SC_CTRL0_PHY_HS_TX_PD BIT(4)
> > +#define OV5648_MIPI_SC_CTRL0_PHY_LP_RX_PD BIT(3)
> > +#define OV5648_MIPI_SC_CTRL0_MIPI_EN BIT(2)
> > +#define OV5648_MIPI_SC_CTRL0_MIPI_SUSP BIT(1)
> > +#define OV5648_MIPI_SC_CTRL0_LANE_DIS_OP BIT(0)
> > +#define OV5648_MIPI_SC_CTRL1_REG 0x3019
> > +#define OV5648_MISC_CTRL0_REG 0x3021
> > +#define OV5648_MIPI_SC_CTRL2_REG 0x3022
> > +#define OV5648_SUB_ID_REG 0x302a
> > +
> > +#define OV5648_PLL_CTRL0_REG 0x3034
> > +#define OV5648_PLL_CTRL0_PLL_CHARGE_PUMP(v) (((v) << 4) & GENMASK(6, 4))
> > +#define OV5648_PLL_CTRL0_BITS(v) ((v) & GENMASK(3, 0))
> > +#define OV5648_PLL_CTRL1_REG 0x3035
> > +#define OV5648_PLL_CTRL1_SYS_DIV(v) (((v) << 4) & GENMASK(7, 4))
> > +#define OV5648_PLL_CTRL1_MIPI_DIV(v) ((v) & GENMASK(3, 0))
> > +#define OV5648_PLL_MUL_REG 0x3036
> > +#define OV5648_PLL_MUL(v) ((v) & GENMASK(7, 0))
> > +#define OV5648_PLL_DIV_REG 0x3037
> > +#define OV5648_PLL_DIV_ROOT_DIV(v) ((((v) - 1) << 4) & BIT(4))
> > +#define OV5648_PLL_DIV_PLL_PRE_DIV(v) ((v) & GENMASK(3, 0))
> > +#define OV5648_PLL_DEBUG_REG 0x3038
> > +#define OV5648_PLL_BYPASS_REG 0x3039
> > +
> > +#define OV5648_PLLS_BYPASS_REG 0x303a
> > +#define OV5648_PLLS_MUL_REG 0x303b
> > +#define OV5648_PLLS_MUL(v) ((v) & GENMASK(4, 0))
> > +#define OV5648_PLLS_CTRL_REG 0x303c
> > +#define OV5648_PLLS_CTRL_PLL_CHARGE_PUMP(v) (((v) << 4) & GENMASK(6, 4))
> > +#define OV5648_PLLS_CTRL_SYS_DIV(v) ((v) & GENMASK(3, 0))
> > +#define OV5648_PLLS_DIV_REG 0x303d
> > +#define OV5648_PLLS_DIV_PLLS_PRE_DIV(v) (((v) << 4) & GENMASK(5, 4))
> > +#define OV5648_PLLS_DIV_PLLS_DIV_R(v) ((((v) - 1) << 2) & BIT(2))
> > +#define OV5648_PLLS_DIV_PLLS_SEL_DIV(v) ((v) & GENMASK(1, 0))
> > +
> > +#define OV5648_SRB_CTRL_REG 0x3106
> > +#define OV5648_SRB_CTRL_SCLK_DIV(v) (((v) << 2) & GENMASK(3, 2))
> > +#define OV5648_SRB_CTRL_RESET_ARBITER_EN BIT(1)
> > +#define OV5648_SRB_CTRL_SCLK_ARBITER_EN BIT(0)
> > +
> > +/* Group Hold */
> > +
> > +#define OV5648_GROUP_ADR0_REG 0x3200
> > +#define OV5648_GROUP_ADR1_REG 0x3201
> > +#define OV5648_GROUP_ADR2_REG 0x3202
> > +#define OV5648_GROUP_ADR3_REG 0x3203
> > +#define OV5648_GROUP_LEN0_REG 0x3204
> > +#define OV5648_GROUP_LEN1_REG 0x3205
> > +#define OV5648_GROUP_LEN2_REG 0x3206
> > +#define OV5648_GROUP_LEN3_REG 0x3207
> > +#define OV5648_GROUP_ACCESS_REG 0x3208
> > +
> > +/* Exposure/gain/banding */
> > +
> > +#define OV5648_EXPOSURE_CTRL_HH_REG 0x3500
> > +#define OV5648_EXPOSURE_CTRL_HH(v) (((v) & GENMASK(19, 16)) >> 16)
> > +#define OV5648_EXPOSURE_CTRL_HH_VALUE(v) (((v) << 16) & GENMASK(19, 16))
> > +#define OV5648_EXPOSURE_CTRL_H_REG 0x3501
> > +#define OV5648_EXPOSURE_CTRL_H(v) (((v) & GENMASK(15, 8)) >> 8)
> > +#define OV5648_EXPOSURE_CTRL_H_VALUE(v) (((v) << 8) & GENMASK(15, 8))
> > +#define OV5648_EXPOSURE_CTRL_L_REG 0x3502
> > +#define OV5648_EXPOSURE_CTRL_L(v) ((v) & GENMASK(7, 0))
> > +#define OV5648_EXPOSURE_CTRL_L_VALUE(v) ((v) & GENMASK(7, 0))
> > +#define OV5648_MANUAL_CTRL_REG 0x3503
> > +#define OV5648_MANUAL_CTRL_FRAME_DELAY(v) (((v) << 4) & GENMASK(5, 4))
> > +#define OV5648_MANUAL_CTRL_AGC_MANUAL_EN BIT(1)
> > +#define OV5648_MANUAL_CTRL_AEC_MANUAL_EN BIT(0)
> > +#define OV5648_GAIN_CTRL_H_REG 0x350a
> > +#define OV5648_GAIN_CTRL_H(v) (((v) & GENMASK(9, 8)) >> 8)
> > +#define OV5648_GAIN_CTRL_H_VALUE(v) (((v) << 8) & GENMASK(9, 8))
> > +#define OV5648_GAIN_CTRL_L_REG 0x350b
> > +#define OV5648_GAIN_CTRL_L(v) ((v) & GENMASK(7, 0))
> > +#define OV5648_GAIN_CTRL_L_VALUE(v) ((v) & GENMASK(7, 0))
> > +
> > +#define OV5648_ANALOG_CTRL0_REG_BASE 0x3600
> > +#define OV5648_ANALOG_CTRL1_REG_BASE 0x3700
> > +
> > +#define OV5648_AEC_CTRL0_REG 0x3a00
> > +#define OV5648_AEC_CTRL0_DEBUG BIT(6)
> > +#define OV5648_AEC_CTRL0_DEBAND_EN BIT(5)
> > +#define OV5648_AEC_CTRL0_DEBAND_LOW_LIMIT_EN BIT(4)
> > +#define OV5648_AEC_CTRL0_START_SEL_EN BIT(3)
> > +#define OV5648_AEC_CTRL0_NIGHT_MODE_EN BIT(2)
> > +#define OV5648_AEC_CTRL0_FREEZE_EN BIT(0)
> > +#define OV5648_EXPOSURE_MIN_REG 0x3a01
> > +#define OV5648_EXPOSURE_MAX_60_H_REG 0x3a02
> > +#define OV5648_EXPOSURE_MAX_60_L_REG 0x3a03
> > +#define OV5648_AEC_CTRL5_REG 0x3a05
> > +#define OV5648_AEC_CTRL6_REG 0x3a06
> > +#define OV5648_AEC_CTRL7_REG 0x3a07
> > +#define OV5648_BANDING_STEP_50_H_REG 0x3a08
> > +#define OV5648_BANDING_STEP_50_L_REG 0x3a09
> > +#define OV5648_BANDING_STEP_60_H_REG 0x3a0a
> > +#define OV5648_BANDING_STEP_60_L_REG 0x3a0b
> > +#define OV5648_AEC_CTRLC_REG 0x3a0c
> > +#define OV5648_BANDING_MAX_60_REG 0x3a0d
> > +#define OV5648_BANDING_MAX_50_REG 0x3a0e
> > +#define OV5648_WPT_REG 0x3a0f
> > +#define OV5648_BPT_REG 0x3a10
> > +#define OV5648_VPT_HIGH_REG 0x3a11
> > +#define OV5648_AVG_MANUAL_REG 0x3a12
> > +#define OV5648_PRE_GAIN_REG 0x3a13
> > +#define OV5648_EXPOSURE_MAX_50_H_REG 0x3a14
> > +#define OV5648_EXPOSURE_MAX_50_L_REG 0x3a15
> > +#define OV5648_GAIN_BASE_NIGHT_REG 0x3a17
> > +#define OV5648_AEC_GAIN_CEILING_H_REG 0x3a18
> > +#define OV5648_AEC_GAIN_CEILING_L_REG 0x3a19
> > +#define OV5648_DIFF_MAX_REG 0x3a1a
> > +#define OV5648_WPT2_REG 0x3a1b
> > +#define OV5648_LED_ADD_ROW_H_REG 0x3a1c
> > +#define OV5648_LED_ADD_ROW_L_REG 0x3a1d
> > +#define OV5648_BPT2_REG 0x3a1e
> > +#define OV5648_VPT_LOW_REG 0x3a1f
> > +#define OV5648_AEC_CTRL20_REG 0x3a20
> > +#define OV5648_AEC_CTRL21_REG 0x3a21
> > +
> > +#define OV5648_AVG_START_X_H_REG 0x5680
> > +#define OV5648_AVG_START_X_L_REG 0x5681
> > +#define OV5648_AVG_START_Y_H_REG 0x5682
> > +#define OV5648_AVG_START_Y_L_REG 0x5683
> > +#define OV5648_AVG_WINDOW_X_H_REG 0x5684
> > +#define OV5648_AVG_WINDOW_X_L_REG 0x5685
> > +#define OV5648_AVG_WINDOW_Y_H_REG 0x5686
> > +#define OV5648_AVG_WINDOW_Y_L_REG 0x5687
> > +#define OV5648_AVG_WEIGHT00_REG 0x5688
> > +#define OV5648_AVG_WEIGHT01_REG 0x5689
> > +#define OV5648_AVG_WEIGHT02_REG 0x568a
> > +#define OV5648_AVG_WEIGHT03_REG 0x568b
> > +#define OV5648_AVG_WEIGHT04_REG 0x568c
> > +#define OV5648_AVG_WEIGHT05_REG 0x568d
> > +#define OV5648_AVG_WEIGHT06_REG 0x568e
> > +#define OV5648_AVG_WEIGHT07_REG 0x568f
> > +#define OV5648_AVG_CTRL10_REG 0x5690
> > +#define OV5648_AVG_WEIGHT_SUM_REG 0x5691
> > +#define OV5648_AVG_READOUT_REG 0x5693
> > +
> > +#define OV5648_DIG_CTRL0_REG 0x5a00
> > +#define OV5648_DIG_COMP_MAN_H_REG 0x5a02
> > +#define OV5648_DIG_COMP_MAN_L_REG 0x5a03
> > +
> > +#define OV5648_GAINC_MAN_H_REG 0x5a20
> > +#define OV5648_GAINC_MAN_L_REG 0x5a21
> > +#define OV5648_GAINC_DGC_MAN_H_REG 0x5a22
> > +#define OV5648_GAINC_DGC_MAN_L_REG 0x5a23
> > +#define OV5648_GAINC_CTRL0_REG 0x5a24
> > +
> > +#define OV5648_GAINF_ANA_NUM_REG 0x5a40
> > +#define OV5648_GAINF_DIG_GAIN_REG 0x5a41
> > +
> > +/* Timing */
> > +
> > +#define OV5648_CROP_START_X_H_REG 0x3800
> > +#define OV5648_CROP_START_X_H(v) (((v) & GENMASK(11, 8)) >> 8)
> > +#define OV5648_CROP_START_X_L_REG 0x3801
> > +#define OV5648_CROP_START_X_L(v) ((v) & GENMASK(7, 0))
> > +#define OV5648_CROP_START_Y_H_REG 0x3802
> > +#define OV5648_CROP_START_Y_H(v) (((v) & GENMASK(11, 8)) >> 8)
> > +#define OV5648_CROP_START_Y_L_REG 0x3803
> > +#define OV5648_CROP_START_Y_L(v) ((v) & GENMASK(7, 0))
> > +#define OV5648_CROP_END_X_H_REG 0x3804
> > +#define OV5648_CROP_END_X_H(v) (((v) & GENMASK(11, 8)) >> 8)
> > +#define OV5648_CROP_END_X_L_REG 0x3805
> > +#define OV5648_CROP_END_X_L(v) ((v) & GENMASK(7, 0))
> > +#define OV5648_CROP_END_Y_H_REG 0x3806
> > +#define OV5648_CROP_END_Y_H(v) (((v) & GENMASK(11, 8)) >> 8)
> > +#define OV5648_CROP_END_Y_L_REG 0x3807
> > +#define OV5648_CROP_END_Y_L(v) ((v) & GENMASK(7, 0))
> > +#define OV5648_OUTPUT_SIZE_X_H_REG 0x3808
> > +#define OV5648_OUTPUT_SIZE_X_H(v) (((v) & GENMASK(11, 8)) >> 8)
> > +#define OV5648_OUTPUT_SIZE_X_L_REG 0x3809
> > +#define OV5648_OUTPUT_SIZE_X_L(v) ((v) & GENMASK(7, 0))
> > +#define OV5648_OUTPUT_SIZE_Y_H_REG 0x380a
> > +#define OV5648_OUTPUT_SIZE_Y_H(v) (((v) & GENMASK(11, 8)) >> 8)
> > +#define OV5648_OUTPUT_SIZE_Y_L_REG 0x380b
> > +#define OV5648_OUTPUT_SIZE_Y_L(v) ((v) & GENMASK(7, 0))
> > +#define OV5648_HTS_H_REG 0x380c
> > +#define OV5648_HTS_H(v) (((v) & GENMASK(12, 8)) >> 8)
> > +#define OV5648_HTS_L_REG 0x380d
> > +#define OV5648_HTS_L(v) ((v) & GENMASK(7, 0))
> > +#define OV5648_VTS_H_REG 0x380e
> > +#define OV5648_VTS_H(v) (((v) & GENMASK(15, 8)) >> 8)
> > +#define OV5648_VTS_L_REG 0x380f
> > +#define OV5648_VTS_L(v) ((v) & GENMASK(7, 0))
> > +#define OV5648_OFFSET_X_H_REG 0x3810
> > +#define OV5648_OFFSET_X_H(v) (((v) & GENMASK(11, 8)) >> 8)
> > +#define OV5648_OFFSET_X_L_REG 0x3811
> > +#define OV5648_OFFSET_X_L(v) ((v) & GENMASK(7, 0))
> > +#define OV5648_OFFSET_Y_H_REG 0x3812
> > +#define OV5648_OFFSET_Y_H(v) (((v) & GENMASK(11, 8)) >> 8)
> > +#define OV5648_OFFSET_Y_L_REG 0x3813
> > +#define OV5648_OFFSET_Y_L(v) ((v) & GENMASK(7, 0))
> > +#define OV5648_SUB_INC_X_REG 0x3814
> > +#define OV5648_SUB_INC_X_ODD(v) (((v) << 4) & GENMASK(7, 4))
> > +#define OV5648_SUB_INC_X_EVEN(v) ((v) & GENMASK(3, 0))
> > +#define OV5648_SUB_INC_Y_REG 0x3815
> > +#define OV5648_SUB_INC_Y_ODD(v) (((v) << 4) & GENMASK(7, 4))
> > +#define OV5648_SUB_INC_Y_EVEN(v) ((v) & GENMASK(3, 0))
> > +#define OV5648_HSYNCST_H_REG 0x3816
> > +#define OV5648_HSYNCST_H(v) (((v) >> 8) & 0xf)
> > +#define OV5648_HSYNCST_L_REG 0x3817
> > +#define OV5648_HSYNCST_L(v) ((v) & GENMASK(7, 0))
> > +#define OV5648_HSYNCW_H_REG 0x3818
> > +#define OV5648_HSYNCW_H(v) (((v) >> 8) & 0xf)
> > +#define OV5648_HSYNCW_L_REG 0x3819
> > +#define OV5648_HSYNCW_L(v) ((v) & GENMASK(7, 0))
> > +
> > +#define OV5648_TC20_REG 0x3820
> > +#define OV5648_TC20_DEBUG BIT(6)
> > +#define OV5648_TC20_FLIP_VERT_ISP_EN BIT(2)
> > +#define OV5648_TC20_FLIP_VERT_SENSOR_EN BIT(1)
> > +#define OV5648_TC20_BINNING_VERT_EN BIT(0)
> > +#define OV5648_TC21_REG 0x3821
> > +#define OV5648_TC21_FLIP_HORZ_ISP_EN BIT(2)
> > +#define OV5648_TC21_FLIP_HORZ_SENSOR_EN BIT(1)
> > +#define OV5648_TC21_BINNING_HORZ_EN BIT(0)
> > +
> > +/* Strobe/exposure */
> > +
> > +#define OV5648_STROBE_REG 0x3b00
> > +#define OV5648_FREX_EXP_HH_REG 0x3b01
> > +#define OV5648_SHUTTER_DLY_H_REG 0x3b02
> > +#define OV5648_SHUTTER_DLY_L_REG 0x3b03
> > +#define OV5648_FREX_EXP_H_REG 0x3b04
> > +#define OV5648_FREX_EXP_L_REG 0x3b05
> > +#define OV5648_FREX_CTRL_REG 0x3b06
> > +#define OV5648_FREX_MODE_SEL_REG 0x3b07
> > +#define OV5648_FREX_MODE_SEL_FREX_SA1 BIT(4)
> > +#define OV5648_FREX_MODE_SEL_FX1_FM_EN BIT(3)
> > +#define OV5648_FREX_MODE_SEL_FREX_INV BIT(2)
> > +#define OV5648_FREX_MODE_SEL_MODE1 0x0
> > +#define OV5648_FREX_MODE_SEL_MODE2 0x1
> > +#define OV5648_FREX_MODE_SEL_ROLLING 0x2
> > +#define OV5648_FREX_EXP_REQ_REG 0x3b08
> > +#define OV5648_FREX_SHUTTER_DLY_REG 0x3b09
> > +#define OV5648_FREX_RST_LEN_REG 0x3b0a
> > +#define OV5648_STROBE_WIDTH_HH_REG 0x3b0b
> > +#define OV5648_STROBE_WIDTH_H_REG 0x3b0c
> > +
> > +/* OTP */
> > +
> > +#define OV5648_OTP_DATA_REG_BASE 0x3d00
> > +#define OV5648_OTP_PROGRAM_CTRL_REG 0x3d80
> > +#define OV5648_OTP_LOAD_CTRL_REG 0x3d81
> > +
> > +/* PSRAM */
> > +
> > +#define OV5648_PSRAM_CTRL1_REG 0x3f01
> > +#define OV5648_PSRAM_CTRLF_REG 0x3f0f
> > +
> > +/* Black Level */
> > +
> > +#define OV5648_BLC_CTRL0_REG 0x4000
> > +#define OV5648_BLC_CTRL1_REG 0x4001
> > +#define OV5648_BLC_CTRL1_START_LINE(v) ((v) & GENMASK(5, 0))
> > +#define OV5648_BLC_CTRL2_REG 0x4002
> > +#define OV5648_BLC_CTRL2_AUTO_EN BIT(6)
> > +#define OV5648_BLC_CTRL2_RESET_FRAME_NUM(v) ((v) & GENMASK(5, 0))
> > +#define OV5648_BLC_CTRL3_REG 0x4003
> > +#define OV5648_BLC_LINE_NUM_REG 0x4004
> > +#define OV5648_BLC_LINE_NUM(v) ((v) & GENMASK(7, 0))
> > +#define OV5648_BLC_CTRL5_REG 0x4005
> > +#define OV5648_BLC_CTRL5_UPDATE_EN BIT(1)
> > +#define OV5648_BLC_LEVEL_REG 0x4009
> > +
> > +/* Frame */
> > +
> > +#define OV5648_FRAME_CTRL_REG 0x4200
> > +#define OV5648_FRAME_ON_NUM_REG 0x4201
> > +#define OV5648_FRAME_OFF_NUM_REG 0x4202
> > +
> > +/* MIPI CSI-2 */
> > +
> > +#define OV5648_MIPI_CTRL0_REG 0x4800
> > +#define OV5648_MIPI_CTRL0_CLK_LANE_AUTOGATE BIT(5)
> > +#define OV5648_MIPI_CTRL0_LANE_SYNC_EN BIT(4)
> > +#define OV5648_MIPI_CTRL0_LANE_SELECT_LANE1 0
> > +#define OV5648_MIPI_CTRL0_LANE_SELECT_LANE2 BIT(3)
> > +#define OV5648_MIPI_CTRL0_IDLE_LP00 0
> > +#define OV5648_MIPI_CTRL0_IDLE_LP11 BIT(2)
> > +
> > +#define OV5648_MIPI_CTRL1_REG 0x4801
> > +#define OV5648_MIPI_CTRL2_REG 0x4802
> > +#define OV5648_MIPI_CTRL3_REG 0x4803
> > +#define OV5648_MIPI_CTRL4_REG 0x4804
> > +#define OV5648_MIPI_CTRL5_REG 0x4805
> > +#define OV5648_MIPI_MAX_FRAME_COUNT_H_REG 0x4810
> > +#define OV5648_MIPI_MAX_FRAME_COUNT_L_REG 0x4811
> > +#define OV5648_MIPI_CTRL14_REG 0x4814
> > +#define OV5648_MIPI_DT_SPKT_REG 0x4815
> > +#define OV5648_MIPI_HS_ZERO_MIN_H_REG 0x4818
> > +#define OV5648_MIPI_HS_ZERO_MIN_L_REG 0x4819
> > +#define OV5648_MIPI_HS_TRAIN_MIN_H_REG 0x481a
> > +#define OV5648_MIPI_HS_TRAIN_MIN_L_REG 0x481b
> > +#define OV5648_MIPI_CLK_ZERO_MIN_H_REG 0x481c
> > +#define OV5648_MIPI_CLK_ZERO_MIN_L_REG 0x481d
> > +#define OV5648_MIPI_CLK_PREPARE_MIN_H_REG 0x481e
> > +#define OV5648_MIPI_CLK_PREPARE_MIN_L_REG 0x481f
> > +#define OV5648_MIPI_CLK_POST_MIN_H_REG 0x4820
> > +#define OV5648_MIPI_CLK_POST_MIN_L_REG 0x4821
> > +#define OV5648_MIPI_CLK_TRAIL_MIN_H_REG 0x4822
> > +#define OV5648_MIPI_CLK_TRAIL_MIN_L_REG 0x4823
> > +#define OV5648_MIPI_LPX_P_MIN_H_REG 0x4824
> > +#define OV5648_MIPI_LPX_P_MIN_L_REG 0x4825
> > +#define OV5648_MIPI_HS_PREPARE_MIN_H_REG 0x4826
> > +#define OV5648_MIPI_HS_PREPARE_MIN_L_REG 0x4827
> > +#define OV5648_MIPI_HS_EXIT_MIN_H_REG 0x4828
> > +#define OV5648_MIPI_HS_EXIT_MIN_L_REG 0x4829
> > +#define OV5648_MIPI_HS_ZERO_MIN_UI_REG 0x482a
> > +#define OV5648_MIPI_HS_TRAIL_MIN_UI_REG 0x482b
> > +#define OV5648_MIPI_CLK_ZERO_MIN_UI_REG 0x482c
> > +#define OV5648_MIPI_CLK_PREPARE_MIN_UI_REG 0x482d
> > +#define OV5648_MIPI_CLK_POST_MIN_UI_REG 0x482e
> > +#define OV5648_MIPI_CLK_TRAIL_MIN_UI_REG 0x482f
> > +#define OV5648_MIPI_LPX_P_MIN_UI_REG 0x4830
> > +#define OV5648_MIPI_HS_PREPARE_MIN_UI_REG 0x4831
> > +#define OV5648_MIPI_HS_EXIT_MIN_UI_REG 0x4832
> > +#define OV5648_MIPI_REG_MIN_H_REG 0x4833
> > +#define OV5648_MIPI_REG_MIN_L_REG 0x4834
> > +#define OV5648_MIPI_REG_MAX_H_REG 0x4835
> > +#define OV5648_MIPI_REG_MAX_L_REG 0x4836
> > +#define OV5648_MIPI_PCLK_PERIOD_REG 0x4837
> > +#define OV5648_MIPI_WKUP_DLY_REG 0x4838
> > +#define OV5648_MIPI_LP_GPIO_REG 0x483b
> > +#define OV5648_MIPI_SNR_PCLK_DIV_REG 0x4843
> > +
> > +/* ISP */
> > +
> > +#define OV5648_ISP_CTRL0_REG 0x5000
> > +#define OV5648_ISP_CTRL0_BLACK_CORRECT_EN BIT(2)
> > +#define OV5648_ISP_CTRL0_WHITE_CORRECT_EN BIT(1)
> > +#define OV5648_ISP_CTRL1_REG 0x5001
> > +#define OV5648_ISP_CTRL1_AWB_EN BIT(0)
> > +#define OV5648_ISP_CTRL2_REG 0x5002
> > +#define OV5648_ISP_CTRL2_WIN_EN BIT(6)
> > +#define OV5648_ISP_CTRL2_OTP_EN BIT(1)
> > +#define OV5648_ISP_CTRL2_AWB_GAIN_EN BIT(0)
> > +#define OV5648_ISP_CTRL3_REG 0x5003
> > +#define OV5648_ISP_CTRL3_BUF_EN BIT(3)
> > +#define OV5648_ISP_CTRL3_BIN_MAN_SET BIT(2)
> > +#define OV5648_ISP_CTRL3_BIN_AUTO_EN BIT(1)
> > +#define OV5648_ISP_CTRL4_REG 0x5004
> > +#define OV5648_ISP_CTRL5_REG 0x5005
> > +#define OV5648_ISP_CTRL6_REG 0x5006
> > +#define OV5648_ISP_CTRL7_REG 0x5007
> > +#define OV5648_ISP_MAN_OFFSET_X_H_REG 0x5008
> > +#define OV5648_ISP_MAN_OFFSET_X_L_REG 0x5009
> > +#define OV5648_ISP_MAN_OFFSET_Y_H_REG 0x500a
> > +#define OV5648_ISP_MAN_OFFSET_Y_L_REG 0x500b
> > +#define OV5648_ISP_MAN_WIN_OFFSET_X_H_REG 0x500c
> > +#define OV5648_ISP_MAN_WIN_OFFSET_X_L_REG 0x500d
> > +#define OV5648_ISP_MAN_WIN_OFFSET_Y_H_REG 0x500e
> > +#define OV5648_ISP_MAN_WIN_OFFSET_Y_L_REG 0x500f
> > +#define OV5648_ISP_MAN_WIN_OUTPUT_X_H_REG 0x5010
> > +#define OV5648_ISP_MAN_WIN_OUTPUT_X_L_REG 0x5011
> > +#define OV5648_ISP_MAN_WIN_OUTPUT_Y_H_REG 0x5012
> > +#define OV5648_ISP_MAN_WIN_OUTPUT_Y_L_REG 0x5013
> > +#define OV5648_ISP_MAN_INPUT_X_H_REG 0x5014
> > +#define OV5648_ISP_MAN_INPUT_X_L_REG 0x5015
> > +#define OV5648_ISP_MAN_INPUT_Y_H_REG 0x5016
> > +#define OV5648_ISP_MAN_INPUT_Y_L_REG 0x5017
> > +#define OV5648_ISP_CTRL18_REG 0x5018
> > +#define OV5648_ISP_CTRL19_REG 0x5019
> > +#define OV5648_ISP_CTRL1A_REG 0x501a
> > +#define OV5648_ISP_CTRL1D_REG 0x501d
> > +#define OV5648_ISP_CTRL1F_REG 0x501f
> > +#define OV5648_ISP_CTRL1F_OUTPUT_EN 3
> > +#define OV5648_ISP_CTRL25_REG 0x5025
> > +
> > +#define OV5648_ISP_CTRL3D_REG 0x503d
> > +#define OV5648_ISP_CTRL3D_PATTERN_EN BIT(7)
> > +#define OV5648_ISP_CTRL3D_ROLLING_BAR_EN BIT(6)
> > +#define OV5648_ISP_CTRL3D_TRANSPARENT_MODE BIT(5)
> > +#define OV5648_ISP_CTRL3D_SQUARES_BW_MODE BIT(4)
> > +#define OV5648_ISP_CTRL3D_PATTERN_COLOR_BARS 0
> > +#define OV5648_ISP_CTRL3D_PATTERN_RANDOM_DATA 1
> > +#define OV5648_ISP_CTRL3D_PATTERN_COLOR_SQUARES 2
> > +#define OV5648_ISP_CTRL3D_PATTERN_INPUT 3
> > +
> > +#define OV5648_ISP_CTRL3E_REG 0x503e
> > +#define OV5648_ISP_CTRL4B_REG 0x504b
> > +#define OV5648_ISP_CTRL4B_POST_BIN_H_EN BIT(5)
> > +#define OV5648_ISP_CTRL4B_POST_BIN_V_EN BIT(4)
> > +#define OV5648_ISP_CTRL4C_REG 0x504c
> > +#define OV5648_ISP_CTRL57_REG 0x5057
> > +#define OV5648_ISP_CTRL58_REG 0x5058
> > +#define OV5648_ISP_CTRL59_REG 0x5059
> > +
> > +#define OV5648_ISP_WINDOW_START_X_H_REG 0x5980
> > +#define OV5648_ISP_WINDOW_START_X_L_REG 0x5981
> > +#define OV5648_ISP_WINDOW_START_Y_H_REG 0x5982
> > +#define OV5648_ISP_WINDOW_START_Y_L_REG 0x5983
> > +#define OV5648_ISP_WINDOW_WIN_X_H_REG 0x5984
> > +#define OV5648_ISP_WINDOW_WIN_X_L_REG 0x5985
> > +#define OV5648_ISP_WINDOW_WIN_Y_H_REG 0x5986
> > +#define OV5648_ISP_WINDOW_WIN_Y_L_REG 0x5987
> > +#define OV5648_ISP_WINDOW_MAN_REG 0x5988
> > +
> > +/* White Balance */
> > +
> > +#define OV5648_AWB_CTRL_REG 0x5180
> > +#define OV5648_AWB_CTRL_FAST_AWB BIT(6)
> > +#define OV5648_AWB_CTRL_GAIN_FREEZE_EN BIT(5)
> > +#define OV5648_AWB_CTRL_SUM_FREEZE_EN BIT(4)
> > +#define OV5648_AWB_CTRL_GAIN_MANUAL_EN BIT(3)
> > +
> > +#define OV5648_AWB_DELTA_REG 0x5181
> > +#define OV5648_AWB_STABLE_RANGE_REG 0x5182
> > +#define OV5648_AWB_STABLE_RANGE_WIDE_REG 0x5183
> > +#define OV5648_HSIZE_MAN_REG 0x5185
> > +
> > +#define OV5648_GAIN_RED_MAN_H_REG 0x5186
> > +#define OV5648_GAIN_RED_MAN_H(v) (((v) & GENMASK(11, 8)) >> 8)
> > +#define OV5648_GAIN_RED_MAN_L_REG 0x5187
> > +#define OV5648_GAIN_RED_MAN_L(v) ((v) & GENMASK(7, 0))
> > +#define OV5648_GAIN_GREEN_MAN_H_REG 0x5188
> > +#define OV5648_GAIN_GREEN_MAN_H(v) (((v) & GENMASK(11, 8)) >> 8)
> > +#define OV5648_GAIN_GREEN_MAN_L_REG 0x5189
> > +#define OV5648_GAIN_GREEN_MAN_L(v) ((v) & GENMASK(7, 0))
> > +#define OV5648_GAIN_BLUE_MAN_H_REG 0x518a
> > +#define OV5648_GAIN_BLUE_MAN_H(v) (((v) & GENMASK(11, 8)) >> 8)
> > +#define OV5648_GAIN_BLUE_MAN_L_REG 0x518b
> > +#define OV5648_GAIN_BLUE_MAN_L(v) ((v) & GENMASK(7, 0))
> > +#define OV5648_GAIN_RED_LIMIT_REG 0x518c
> > +#define OV5648_GAIN_GREEN_LIMIT_REG 0x518d
> > +#define OV5648_GAIN_BLUE_LIMIT_REG 0x518e
> > +#define OV5648_AWB_FRAME_COUNT_REG 0x518f
> > +#define OV5648_AWB_BASE_MAN_REG 0x51df
> > +
> > +/* Macros */
> > +
> > +#define ov5648_subdev_sensor(subdev) \
> > + container_of(subdev, struct ov5648_sensor, subdev)
>
> Please call the macro argument differently than the struct member. Now the
> argument may be only called "subdev".
>
> > +
> > +#define ov5648_ctrl_subdev(ctrl) \
> > + (&container_of(ctrl->handler, struct ov5648_sensor, ctrls.handler)->subdev)
> > +
> > +/* Data structures */
> > +
> > +struct ov5648_register_value {
> > + u16 address;
> > + u8 value;
> > + unsigned int delay_ms;
> > +};
> > +
> > +/*
> > + * PLL1 Clock Tree:
> > + *
> > + * +-< XVCLK
> > + * |
> > + * +-+ pll_pre_div (0x3037 [3:0], special values: 5: 1.5, 7: 2.5)
> > + * |
> > + * +-+ pll_mul (0x3036 [7:0])
> > + * |
> > + * +-+ sys_div (0x3035 [7:4])
> > + * |
> > + * +-+ mipi_div (0x3035 [3:0])
> > + * | |
> > + * | +-> MIPI_SCLK
> > + * | |
> > + * | +-+ mipi_phy_div (2)
> > + * | |
> > + * | +-> MIPI_CLK
> > + * |
> > + * +-+ root_div (0x3037 [4])
> > + * |
> > + * +-+ bit_div (0x3034 [3:0], 8 bits: 2, 10 bits: 2.5, other: 1)
> > + * |
> > + * +-+ sclk_div (0x3106 [3:2])
> > + * |
> > + * +-> SCLK
> > + * |
> > + * +-+ mipi_div (0x3035, 1: PCLK = SCLK)
> > + * |
> > + * +-> PCLK
> > + */
> > +
> > +struct ov5648_pll1_config {
> > + unsigned int pll_pre_div;
> > + unsigned int pll_mul;
> > + unsigned int sys_div;
> > + unsigned int root_div;
> > + unsigned int sclk_div;
> > + unsigned int mipi_div;
> > +};
> > +
> > +/*
> > + * PLL2 Clock Tree:
> > + *
> > + * +-< XVCLK
> > + * |
> > + * +-+ plls_pre_div (0x303d [5:4], special values: 0: 1, 1: 1.5)
> > + * |
> > + * +-+ plls_div_r (0x303d [2])
> > + * |
> > + * +-+ plls_mul (0x303b [4:0])
> > + * |
> > + * +-+ sys_div (0x303c [3:0])
> > + * |
> > + * +-+ sel_div (0x303d [1:0], special values: 0: 1, 3: 2.5)
> > + * |
> > + * +-> ADCLK
> > + */
> > +
> > +struct ov5648_pll2_config {
> > + unsigned int plls_pre_div;
> > + unsigned int plls_div_r;
> > + unsigned int plls_mul;
> > + unsigned int sys_div;
> > + unsigned int sel_div;
> > +};
> > +
> > +/*
> > + * General formulas for (array-centered) mode calculation:
> > + * - photo_array_width = 2624
> > + * - crop_start_x = (photo_array_width - output_size_x) / 2
> > + * - crop_end_x = crop_start_x + offset_x + output_size_x - 1
> > + *
> > + * - photo_array_height = 1956
> > + * - crop_start_y = (photo_array_height - output_size_y) / 2
> > + * - crop_end_y = crop_start_y + offset_y + output_size_y - 1
> > + */
> > +
> > +struct ov5648_mode {
> > + unsigned int crop_start_x;
> > + unsigned int offset_x;
> > + unsigned int output_size_x;
> > + unsigned int crop_end_x;
> > + unsigned int hts;
> > +
> > + unsigned int crop_start_y;
> > + unsigned int offset_y;
> > + unsigned int output_size_y;
> > + unsigned int crop_end_y;
> > + unsigned int vts;
> > +
> > + bool binning_x;
> > + bool binning_y;
> > +
> > + unsigned int inc_x_odd;
> > + unsigned int inc_x_even;
> > + unsigned int inc_y_odd;
> > + unsigned int inc_y_even;
> > +
> > + /* 8-bit frame interval followed by 10-bit frame interval. */
> > + struct v4l2_fract frame_interval[2];
> > +
> > + /* 8-bit config followed by 10-bit config. */
> > + const struct ov5648_pll1_config *pll1_config[2];
> > + const struct ov5648_pll2_config *pll2_config;
> > +
> > + const struct ov5648_register_value *register_values;
> > + unsigned int register_values_count;
> > +};
> > +
> > +struct ov5648_state {
> > + const struct ov5648_mode *mode;
> > + u32 mbus_code;
> > +
> > + bool streaming;
> > +};
> > +
> > +struct ov5648_ctrls {
> > + struct v4l2_ctrl *exposure_auto;
> > + struct v4l2_ctrl *exposure;
> > +
> > + struct v4l2_ctrl *gain_auto;
> > + struct v4l2_ctrl *gain;
> > +
> > + struct v4l2_ctrl *white_balance_auto;
> > + struct v4l2_ctrl *red_balance;
> > + struct v4l2_ctrl *blue_balance;
> > +
> > + struct v4l2_ctrl *link_freq;
> > + struct v4l2_ctrl *pixel_rate;
> > +
> > + struct v4l2_ctrl_handler handler;
> > +} __packed;
> > +
> > +struct ov5648_sensor {
> > + struct device *dev;
> > + struct i2c_client *i2c_client;
> > + struct gpio_desc *reset;
> > + struct gpio_desc *powerdown;
> > + struct regulator *avdd;
> > + struct regulator *dvdd;
> > + struct regulator *dovdd;
> > + struct clk *xvclk;
> > +
> > + struct v4l2_fwnode_endpoint endpoint;
> > + struct v4l2_subdev subdev;
> > + struct media_pad pad;
> > +
> > + struct mutex mutex;
> > +
> > + struct ov5648_state state;
> > + struct ov5648_ctrls ctrls;
> > +};
> > +
> > +/* Static definitions */
> > +
> > +/*
> > + * XVCLK = 24 MHz
> > + * SCLK = 84 MHz
> > + * PCLK = 84 MHz
> > + */
> > +static const struct ov5648_pll1_config ov5648_pll1_config_native_8_bits = {
> > + .pll_pre_div = 3,
> > + .pll_mul = 84,
> > + .sys_div = 2,
> > + .root_div = 1,
> > + .sclk_div = 1,
> > + .mipi_div = 1,
> > +};
> > +
> > +/*
> > + * XVCLK = 24 MHz
> > + * SCLK = 84 MHz
> > + * PCLK = 84 MHz
> > + */
> > +static const struct ov5648_pll1_config ov5648_pll1_config_native_10_bits = {
> > + .pll_pre_div = 3,
> > + .pll_mul = 105,
> > + .sys_div = 2,
> > + .root_div = 1,
> > + .sclk_div = 1,
> > + .mipi_div = 1,
> > +};
> > +
> > +/*
> > + * XVCLK = 24 MHz
> > + * ADCLK = 200 MHz
> > + */
> > +static const struct ov5648_pll2_config ov5648_pll2_config_native = {
> > + .plls_pre_div = 3,
> > + .plls_div_r = 1,
> > + .plls_mul = 25,
> > + .sys_div = 1,
> > + .sel_div = 1,
> > +};
> > +
> > +static const struct ov5648_mode ov5648_modes[] = {
> > + /* 2592x1944 */
> > + {
> > + /* Horizontal */
> > + .crop_start_x = 16,
> > + .offset_x = 0,
> > + .output_size_x = 2592,
> > + .crop_end_x = 2607,
> > + .hts = 2816,
> > +
> > + /* Vertical */
> > + .crop_start_y = 6,
> > + .offset_y = 0,
> > + .output_size_y = 1944,
> > + .crop_end_y = 1949,
> > + .vts = 1984,
> > +
> > + /* Subsample increase */
> > + .inc_x_odd = 1,
> > + .inc_x_even = 1,
> > + .inc_y_odd = 1,
> > + .inc_y_even = 1,
> > +
> > + /* Frame Interval */
> > + .frame_interval = {
> > + { 1, 15 },
> > + { 1, 15 },
> > + },
> > +
> > + /* PLL */
> > + .pll1_config = {
> > + &ov5648_pll1_config_native_8_bits,
> > + &ov5648_pll1_config_native_10_bits,
> > + },
> > + .pll2_config = &ov5648_pll2_config_native,
> > + },
> > + /* 1600x1200 (UXGA) */
> > + {
> > + /* Horizontal */
> > + .crop_start_x = 512,
> > + .offset_x = 0,
> > + .output_size_x = 1600,
> > + .crop_end_x = 2111,
> > + .hts = 2816,
> > +
> > + /* Vertical */
> > + .crop_start_y = 378,
> > + .offset_y = 0,
> > + .output_size_y = 1200,
> > + .crop_end_y = 1577,
> > + .vts = 1984,
> > +
> > + /* Subsample increase */
> > + .inc_x_odd = 1,
> > + .inc_x_even = 1,
> > + .inc_y_odd = 1,
> > + .inc_y_even = 1,
> > +
> > + /* Frame Interval */
> > + .frame_interval = {
> > + { 1, 15 },
> > + { 1, 15 },
> > + },
> > +
> > + /* PLL */
> > + .pll1_config = {
> > + &ov5648_pll1_config_native_8_bits,
> > + &ov5648_pll1_config_native_10_bits,
> > + },
> > + .pll2_config = &ov5648_pll2_config_native,
> > + },
> > + /* 1920x1080 (Full HD) */
> > + {
> > + /* Horizontal */
> > + .crop_start_x = 352,
> > + .offset_x = 0,
> > + .output_size_x = 1920,
> > + .crop_end_x = 2271,
> > + .hts = 2816,
> > +
> > + /* Vertical */
> > + .crop_start_y = 438,
> > + .offset_y = 0,
> > + .output_size_y = 1080,
> > + .crop_end_y = 1517,
> > + .vts = 1984,
> > +
> > + /* Subsample increase */
> > + .inc_x_odd = 1,
> > + .inc_x_even = 1,
> > + .inc_y_odd = 1,
> > + .inc_y_even = 1,
> > +
> > + /* Frame Interval */
> > + .frame_interval = {
> > + { 1, 15 },
> > + { 1, 15 },
> > + },
> > +
> > + /* PLL */
> > + .pll1_config = {
> > + &ov5648_pll1_config_native_8_bits,
> > + &ov5648_pll1_config_native_10_bits,
> > + },
> > + .pll2_config = &ov5648_pll2_config_native,
> > + },
> > + /* 1280x960 */
> > + {
> > + /* Horizontal */
> > + .crop_start_x = 16,
> > + .offset_x = 8,
> > + .output_size_x = 1280,
> > + .crop_end_x = 2607,
> > + .hts = 1912,
> > +
> > + /* Vertical */
> > + .crop_start_y = 6,
> > + .offset_y = 6,
> > + .output_size_y = 960,
> > + .crop_end_y = 1949,
> > + .vts = 1496,
> > +
> > + /* Binning */
> > + .binning_x = true,
> > +
> > + /* Subsample increase */
> > + .inc_x_odd = 3,
> > + .inc_x_even = 1,
> > + .inc_y_odd = 3,
> > + .inc_y_even = 1,
> > +
> > + /* Frame Interval */
> > + .frame_interval = {
> > + { 1, 30 },
> > + { 1, 30 },
> > + },
> > +
> > + /* PLL */
> > + .pll1_config = {
> > + &ov5648_pll1_config_native_8_bits,
> > + &ov5648_pll1_config_native_10_bits,
> > + },
> > + .pll2_config = &ov5648_pll2_config_native,
> > + },
> > + /* 1280x720 (HD) */
> > + {
> > + /* Horizontal */
> > + .crop_start_x = 16,
> > + .offset_x = 8,
> > + .output_size_x = 1280,
> > + .crop_end_x = 2607,
> > + .hts = 1912,
> > +
> > + /* Vertical */
> > + .crop_start_y = 254,
> > + .offset_y = 2,
> > + .output_size_y = 720,
> > + .crop_end_y = 1701,
> > + .vts = 1496,
> > +
> > + /* Binning */
> > + .binning_x = true,
> > +
> > + /* Subsample increase */
> > + .inc_x_odd = 3,
> > + .inc_x_even = 1,
> > + .inc_y_odd = 3,
> > + .inc_y_even = 1,
> > +
> > + /* Frame Interval */
> > + .frame_interval = {
> > + { 1, 30 },
> > + { 1, 30 },
> > + },
> > +
> > + /* PLL */
> > + .pll1_config = {
> > + &ov5648_pll1_config_native_8_bits,
> > + &ov5648_pll1_config_native_10_bits,
> > + },
> > + .pll2_config = &ov5648_pll2_config_native,
> > + },
> > + /* 640x480 (VGA) */
> > + {
> > + /* Horizontal */
> > + .crop_start_x = 0,
> > + .offset_x = 8,
> > + .output_size_x = 640,
> > + .crop_end_x = 2623,
> > + .hts = 1896,
> > +
> > + /* Vertical */
> > + .crop_start_y = 0,
> > + .offset_y = 2,
> > + .output_size_y = 480,
> > + .crop_end_y = 1953,
> > + .vts = 984,
> > +
> > + /* Binning */
> > + .binning_x = true,
> > +
> > + /* Subsample increase */
> > + .inc_x_odd = 7,
> > + .inc_x_even = 1,
> > + .inc_y_odd = 7,
> > + .inc_y_even = 1,
> > +
> > + /* Frame Interval */
> > + .frame_interval = {
> > + { 1, 30 },
> > + { 1, 30 },
> > + },
> > +
> > + /* PLL */
> > + .pll1_config = {
> > + &ov5648_pll1_config_native_8_bits,
> > + &ov5648_pll1_config_native_10_bits,
> > + },
> > + .pll2_config = &ov5648_pll2_config_native,
> > + },
> > +};
> > +
> > +static const u32 ov5648_mbus_codes[] = {
> > + MEDIA_BUS_FMT_SBGGR8_1X8,
> > + MEDIA_BUS_FMT_SBGGR10_1X10,
> > +};
> > +
> > +static const struct ov5648_register_value ov5648_init_sequence[] = {
> > + /* PSRAM */
> > + { OV5648_PSRAM_CTRL1_REG, 0x0d },
> > + { OV5648_PSRAM_CTRLF_REG, 0xf5 },
> > +};
> > +
> > +static const s64 ov5648_link_freq_menu[] = {
> > + 210000000,
> > + 168000000,
> > +};
> > +
> > +static const char *const ov5648_test_pattern_menu[] = {
> > + "Disabled",
> > + "Random data",
> > + "Color bars",
> > + "Color bars with rolling bar",
> > + "Color squares",
> > + "Color squares with rolling bar"
> > +};
> > +
> > +static const u8 ov5648_test_pattern_bits[] = {
> > + 0,
> > + OV5648_ISP_CTRL3D_PATTERN_EN | OV5648_ISP_CTRL3D_PATTERN_RANDOM_DATA,
> > + OV5648_ISP_CTRL3D_PATTERN_EN | OV5648_ISP_CTRL3D_PATTERN_COLOR_BARS,
> > + OV5648_ISP_CTRL3D_PATTERN_EN | OV5648_ISP_CTRL3D_ROLLING_BAR_EN |
> > + OV5648_ISP_CTRL3D_PATTERN_COLOR_BARS,
> > + OV5648_ISP_CTRL3D_PATTERN_EN | OV5648_ISP_CTRL3D_PATTERN_COLOR_SQUARES,
> > + OV5648_ISP_CTRL3D_PATTERN_EN | OV5648_ISP_CTRL3D_ROLLING_BAR_EN |
> > + OV5648_ISP_CTRL3D_PATTERN_COLOR_SQUARES,
> > +};
> > +
> > +/* Input/Output */
> > +
> > +static int ov5648_read(struct ov5648_sensor *sensor, u16 address, u8 *value)
> > +{
> > + unsigned char data[2] = { address >> 8, address & 0xff };
> > + struct i2c_client *client = sensor->i2c_client;
> > + int ret;
> > +
> > + ret = i2c_master_send(client, data, sizeof(data));
> > + if (ret < 0) {
> > + dev_dbg(&client->dev, "i2c send error at address %#04x\n",
> > + address);
> > + return ret;
> > + }
> > +
> > + ret = i2c_master_recv(client, value, 1);
> > + if (ret < 0) {
> > + dev_dbg(&client->dev, "i2c recv error at address %#04x\n",
> > + address);
> > + return ret;
> > + }
> > +
> > + return 0;
> > +}
> > +
> > +static int ov5648_write(struct ov5648_sensor *sensor, u16 address, u8 value)
> > +{
> > + unsigned char data[3] = { address >> 8, address & 0xff, value };
> > + struct i2c_client *client = sensor->i2c_client;
> > + int ret;
> > +
> > + ret = i2c_master_send(client, data, sizeof(data));
> > + if (ret < 0) {
> > + dev_dbg(&client->dev, "i2c send error at address %#04x\n",
> > + address);
> > + return ret;
> > + }
> > +
> > + return 0;
> > +}
> > +
> > +static int ov5648_write_sequence(struct ov5648_sensor *sensor,
> > + const struct ov5648_register_value *sequence,
> > + unsigned int sequence_count)
> > +{
> > + unsigned int i;
> > + int ret = 0;
> > +
> > + for (i = 0; i < sequence_count; i++) {
> > + ret = ov5648_write(sensor, sequence[i].address,
> > + sequence[i].value);
> > + if (ret)
> > + break;
> > +
> > + if (sequence[i].delay_ms)
> > + msleep(sequence[i].delay_ms);
> > + }
> > +
> > + return ret;
> > +}
> > +
> > +static int ov5648_update_bits(struct ov5648_sensor *sensor, u16 address,
> > + u8 mask, u8 bits)
> > +{
> > + u8 value = 0;
> > + int ret;
> > +
> > + ret = ov5648_read(sensor, address, &value);
> > + if (ret)
> > + return ret;
> > +
> > + value &= ~mask;
> > + value |= bits;
> > +
> > + ret = ov5648_write(sensor, address, value);
> > + if (ret)
> > + return ret;
> > +
> > + return 0;
> > +}
> > +
> > +/* Sensor */
> > +
> > +static int ov5648_sw_reset(struct ov5648_sensor *sensor)
> > +{
> > + int ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_SW_RESET_REG, OV5648_SW_RESET_RESET);
>
> return ov5648_write(...);
>
> There seem to be a few others like that left.
>
> > + if (ret < 0)
> > + return ret;
> > +
> > + return 0;
> > +}
> > +
> > +static int ov5648_sw_standby(struct ov5648_sensor *sensor, int standby)
> > +{
> > + u8 value = 0;
> > + int ret;
> > +
> > + if (!standby)
> > + value = OV5648_SW_STANDBY_STREAM_ON;
> > +
> > + ret = ov5648_write(sensor, OV5648_SW_STANDBY_REG, value);
> > + if (ret < 0)
> > + return ret;
> > +
> > + return 0;
> > +}
> > +
> > +static int ov5648_chip_id_check(struct ov5648_sensor *sensor)
> > +{
> > + u16 regs[] = { OV5648_CHIP_ID_H_REG, OV5648_CHIP_ID_L_REG };
> > + u8 values[] = { OV5648_CHIP_ID_H_VALUE, OV5648_CHIP_ID_L_VALUE };
> > + unsigned int i;
> > + u8 value;
> > + int ret;
> > +
> > + for (i = 0; i < ARRAY_SIZE(regs); i++) {
> > + ret = ov5648_read(sensor, regs[i], &value);
> > + if (ret < 0)
> > + return ret;
> > +
> > + if (value != values[i]) {
> > + dev_err(sensor->dev,
> > + "chip id value mismatch: %#x instead of %#x\n",
> > + value, values[i]);
> > + return -EINVAL;
> > + }
> > + }
> > +
> > + return 0;
> > +}
> > +
> > +static int ov5648_avdd_internal_power(struct ov5648_sensor *sensor, int on)
> > +{
> > + return ov5648_write(sensor, OV5648_A_PWC_PK_O0_REG,
> > + on ? 0 : OV5648_A_PWC_PK_O0_BP_REGULATOR_N);
> > +}
> > +
> > +static int ov5648_pad_configure(struct ov5648_sensor *sensor)
> > +{
> > + int ret;
> > +
> > + /* Configure pads as input. */
> > +
> > + ret = ov5648_write(sensor, OV5648_PAD_OEN1_REG, 0);
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_PAD_OEN2_REG, 0);
> > + if (ret)
> > + return ret;
> > +
> > + /* Disable FREX pin. */
> > +
> > + return ov5648_write(sensor, OV5648_PAD_PK_REG,
> > + OV5648_PAD_PK_DRIVE_STRENGTH_1X |
> > + OV5648_PAD_PK_FREX_N);
> > +}
> > +
> > +static int ov5648_mipi_configure(struct ov5648_sensor *sensor)
> > +{
> > + struct v4l2_fwnode_bus_mipi_csi2 *bus_mipi_csi2 =
> > + &sensor->endpoint.bus.mipi_csi2;
> > + unsigned int lanes_count = bus_mipi_csi2->num_data_lanes;
> > + int ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_MIPI_CTRL0_REG,
> > + OV5648_MIPI_CTRL0_CLK_LANE_AUTOGATE |
> > + OV5648_MIPI_CTRL0_LANE_SELECT_LANE1 |
> > + OV5648_MIPI_CTRL0_IDLE_LP11);
> > + if (ret)
> > + return ret;
> > +
> > + return ov5648_write(sensor, OV5648_MIPI_SC_CTRL0_REG,
> > + OV5648_MIPI_SC_CTRL0_MIPI_LANES(lanes_count) |
> > + OV5648_MIPI_SC_CTRL0_PHY_LP_RX_PD |
> > + OV5648_MIPI_SC_CTRL0_MIPI_EN);
> > +}
> > +
> > +static int ov5648_black_level_configure(struct ov5648_sensor *sensor)
> > +{
> > + int ret;
> > +
> > + /* Up to 6 lines are available for black level calibration. */
> > +
> > + ret = ov5648_write(sensor, OV5648_BLC_CTRL1_REG,
> > + OV5648_BLC_CTRL1_START_LINE(2));
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_BLC_CTRL2_REG,
> > + OV5648_BLC_CTRL2_AUTO_EN |
> > + OV5648_BLC_CTRL2_RESET_FRAME_NUM(5));
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_BLC_LINE_NUM_REG,
> > + OV5648_BLC_LINE_NUM(4));
> > + if (ret)
> > + return ret;
> > +
> > + return ov5648_update_bits(sensor, OV5648_BLC_CTRL5_REG,
> > + OV5648_BLC_CTRL5_UPDATE_EN,
> > + OV5648_BLC_CTRL5_UPDATE_EN);
> > +}
> > +
> > +static int ov5648_isp_configure(struct ov5648_sensor *sensor)
> > +{
> > + u8 bits;
> > + int ret;
> > +
> > + /* Enable black and white level correction. */
> > + bits = OV5648_ISP_CTRL0_BLACK_CORRECT_EN |
> > + OV5648_ISP_CTRL0_WHITE_CORRECT_EN;
> > +
> > + ret = ov5648_update_bits(sensor, OV5648_ISP_CTRL0_REG, bits, bits);
> > + if (ret)
> > + return ret;
> > +
> > + /* Enable AWB. */
> > + ret = ov5648_write(sensor, OV5648_ISP_CTRL1_REG,
> > + OV5648_ISP_CTRL1_AWB_EN);
> > + if (ret)
> > + return ret;
> > +
> > + /* Enable AWB gain and windowing. */
> > + ret = ov5648_write(sensor, OV5648_ISP_CTRL2_REG,
> > + OV5648_ISP_CTRL2_WIN_EN |
> > + OV5648_ISP_CTRL2_AWB_GAIN_EN);
> > + if (ret)
> > + return ret;
> > +
> > + /* Enable buffering and auto-binning. */
> > + ret = ov5648_write(sensor, OV5648_ISP_CTRL3_REG,
> > + OV5648_ISP_CTRL3_BUF_EN |
> > + OV5648_ISP_CTRL3_BIN_AUTO_EN);
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_ISP_CTRL4_REG, 0);
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_ISP_CTRL1F_REG,
> > + OV5648_ISP_CTRL1F_OUTPUT_EN);
> > + if (ret)
> > + return ret;
> > +
> > + /* Enable post-binning filters. */
> > + ret = ov5648_write(sensor, OV5648_ISP_CTRL4B_REG,
> > + OV5648_ISP_CTRL4B_POST_BIN_H_EN |
> > + OV5648_ISP_CTRL4B_POST_BIN_V_EN);
> > + if (ret)
> > + return ret;
> > +
> > + /* Disable debanding and night mode. Debug bit seems necessary. */
> > + ret = ov5648_write(sensor, OV5648_AEC_CTRL0_REG,
> > + OV5648_AEC_CTRL0_DEBUG |
> > + OV5648_AEC_CTRL0_START_SEL_EN);
> > + if (ret)
> > + return ret;
> > +
> > + return ov5648_write(sensor, OV5648_MANUAL_CTRL_REG,
> > + OV5648_MANUAL_CTRL_FRAME_DELAY(1));
> > +}
> > +
> > +static unsigned long ov5648_mode_pll1_rate(struct ov5648_sensor *sensor,
> > + const struct ov5648_pll1_config *config)
> > +{
> > + unsigned long xvclk_rate;
> > + unsigned long pll1_rate;
> > +
> > + xvclk_rate = clk_get_rate(sensor->xvclk);
> > + pll1_rate = xvclk_rate * config->pll_mul;
> > +
> > + switch (config->pll_pre_div) {
> > + case 5:
> > + pll1_rate *= 3;
> > + pll1_rate /= 2;
> > + break;
> > + case 7:
> > + pll1_rate *= 5;
> > + pll1_rate /= 2;
> > + break;
> > + default:
> > + pll1_rate /= config->pll_pre_div;
> > + break;
> > + }
> > +
> > + return pll1_rate;
> > +}
> > +
> > +static int ov5648_mode_pll1_configure(struct ov5648_sensor *sensor,
> > + const struct ov5648_mode *mode,
> > + u32 mbus_code)
> > +{
> > + const struct ov5648_pll1_config *config;
> > + u8 value;
> > + int ret;
> > +
> > + value = OV5648_PLL_CTRL0_PLL_CHARGE_PUMP(1);
> > +
> > + switch (mbus_code) {
> > + case MEDIA_BUS_FMT_SBGGR8_1X8:
> > + config = mode->pll1_config[0];
> > + value |= OV5648_PLL_CTRL0_BITS(8);
> > + break;
> > + case MEDIA_BUS_FMT_SBGGR10_1X10:
> > + config = mode->pll1_config[1];
> > + value |= OV5648_PLL_CTRL0_BITS(10);
> > + break;
> > + default:
> > + return -EINVAL;
> > + }
> > +
> > + ret = ov5648_write(sensor, OV5648_PLL_CTRL0_REG, value);
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_PLL_DIV_REG,
> > + OV5648_PLL_DIV_ROOT_DIV(config->root_div) |
> > + OV5648_PLL_DIV_PLL_PRE_DIV(config->pll_pre_div));
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_PLL_MUL_REG,
> > + OV5648_PLL_MUL(config->pll_mul));
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_PLL_CTRL1_REG,
> > + OV5648_PLL_CTRL1_SYS_DIV(config->sys_div) |
> > + OV5648_PLL_CTRL1_MIPI_DIV(config->mipi_div));
> > + if (ret)
> > + return ret;
> > +
> > + return ov5648_write(sensor, OV5648_SRB_CTRL_REG,
> > + OV5648_SRB_CTRL_SCLK_DIV(config->sclk_div) |
> > + OV5648_SRB_CTRL_SCLK_ARBITER_EN);
> > +}
> > +
> > +static int ov5648_mode_pll2_configure(struct ov5648_sensor *sensor,
> > + const struct ov5648_mode *mode)
> > +{
> > + const struct ov5648_pll2_config *config = mode->pll2_config;
> > + int ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_PLLS_DIV_REG,
> > + OV5648_PLLS_DIV_PLLS_PRE_DIV(config->plls_pre_div) |
> > + OV5648_PLLS_DIV_PLLS_DIV_R(config->plls_div_r) |
> > + OV5648_PLLS_DIV_PLLS_SEL_DIV(config->sel_div));
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_PLLS_MUL_REG,
> > + OV5648_PLLS_MUL(config->plls_mul));
> > + if (ret)
> > + return ret;
> > +
> > + return ov5648_write(sensor, OV5648_PLLS_CTRL_REG,
> > + OV5648_PLLS_CTRL_PLL_CHARGE_PUMP(1) |
> > + OV5648_PLLS_CTRL_SYS_DIV(config->sys_div));
> > +}
> > +
> > +static int ov5648_mode_configure(struct ov5648_sensor *sensor,
> > + const struct ov5648_mode *mode, u32 mbus_code)
> > +{
> > + int ret;
> > +
> > + /* Crop Start X */
> > +
> > + ret = ov5648_write(sensor, OV5648_CROP_START_X_H_REG,
> > + OV5648_CROP_START_X_H(mode->crop_start_x));
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_CROP_START_X_L_REG,
> > + OV5648_CROP_START_X_L(mode->crop_start_x));
> > + if (ret)
> > + return ret;
> > +
> > + /* Offset X */
> > +
> > + ret = ov5648_write(sensor, OV5648_OFFSET_X_H_REG,
> > + OV5648_OFFSET_X_H(mode->offset_x));
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_OFFSET_X_L_REG,
> > + OV5648_OFFSET_X_L(mode->offset_x));
> > + if (ret)
> > + return ret;
> > +
> > + /* Output Size X */
> > +
> > + ret = ov5648_write(sensor, OV5648_OUTPUT_SIZE_X_H_REG,
> > + OV5648_OUTPUT_SIZE_X_H(mode->output_size_x));
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_OUTPUT_SIZE_X_L_REG,
> > + OV5648_OUTPUT_SIZE_X_L(mode->output_size_x));
> > + if (ret)
> > + return ret;
> > +
> > + /* Crop End X */
> > +
> > + ret = ov5648_write(sensor, OV5648_CROP_END_X_H_REG,
> > + OV5648_CROP_END_X_H(mode->crop_end_x));
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_CROP_END_X_L_REG,
> > + OV5648_CROP_END_X_L(mode->crop_end_x));
> > + if (ret)
> > + return ret;
> > +
> > + /* Horizontal Total Size */
> > +
> > + ret = ov5648_write(sensor, OV5648_HTS_H_REG, OV5648_HTS_H(mode->hts));
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_HTS_L_REG, OV5648_HTS_L(mode->hts));
> > + if (ret)
> > + return ret;
> > +
> > + /* Crop Start Y */
> > +
> > + ret = ov5648_write(sensor, OV5648_CROP_START_Y_H_REG,
> > + OV5648_CROP_START_Y_H(mode->crop_start_y));
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_CROP_START_Y_L_REG,
> > + OV5648_CROP_START_Y_L(mode->crop_start_y));
> > + if (ret)
> > + return ret;
> > +
> > + /* Offset Y */
> > +
> > + ret = ov5648_write(sensor, OV5648_OFFSET_Y_H_REG,
> > + OV5648_OFFSET_Y_H(mode->offset_y));
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_OFFSET_Y_L_REG,
> > + OV5648_OFFSET_Y_L(mode->offset_y));
> > + if (ret)
> > + return ret;
> > +
> > + /* Output Size Y */
> > +
> > + ret = ov5648_write(sensor, OV5648_OUTPUT_SIZE_Y_H_REG,
> > + OV5648_OUTPUT_SIZE_Y_H(mode->output_size_y));
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_OUTPUT_SIZE_Y_L_REG,
> > + OV5648_OUTPUT_SIZE_Y_L(mode->output_size_y));
> > + if (ret)
> > + return ret;
> > +
> > + /* Crop End Y */
> > +
> > + ret = ov5648_write(sensor, OV5648_CROP_END_Y_H_REG,
> > + OV5648_CROP_END_Y_H(mode->crop_end_y));
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_CROP_END_Y_L_REG,
> > + OV5648_CROP_END_Y_L(mode->crop_end_y));
> > + if (ret)
> > + return ret;
> > +
> > + /* Vertical Total Size */
> > +
> > + ret = ov5648_write(sensor, OV5648_VTS_H_REG, OV5648_VTS_H(mode->vts));
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_VTS_L_REG, OV5648_VTS_L(mode->vts));
> > + if (ret)
> > + return ret;
> > +
> > + /* Flip/Mirror/Binning */
> > +
> > + /*
> > + * A debug bit is enabled by default and needs to be cleared for
> > + * subsampling to work.
> > + */
> > + ret = ov5648_update_bits(sensor, OV5648_TC20_REG,
> > + OV5648_TC20_DEBUG |
> > + OV5648_TC20_BINNING_VERT_EN,
> > + mode->binning_y ? OV5648_TC20_BINNING_VERT_EN :
> > + 0);
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_update_bits(sensor, OV5648_TC21_REG,
> > + OV5648_TC21_BINNING_HORZ_EN,
> > + mode->binning_x ? OV5648_TC21_BINNING_HORZ_EN :
> > + 0);
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_SUB_INC_X_REG,
> > + OV5648_SUB_INC_X_ODD(mode->inc_x_odd) |
> > + OV5648_SUB_INC_X_EVEN(mode->inc_x_even));
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_SUB_INC_Y_REG,
> > + OV5648_SUB_INC_Y_ODD(mode->inc_y_odd) |
> > + OV5648_SUB_INC_Y_EVEN(mode->inc_y_even));
> > + if (ret)
> > + return ret;
> > +
> > + /* PLLs */
> > +
> > + ret = ov5648_mode_pll1_configure(sensor, mode, mbus_code);
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_mode_pll2_configure(sensor, mode);
> > + if (ret)
> > + return ret;
> > +
> > + /* Extra registers */
> > +
> > + if (mode->register_values) {
> > + ret = ov5648_write_sequence(sensor, mode->register_values,
> > + mode->register_values_count);
> > + if (ret)
> > + return ret;
> > + }
> > +
> > + return 0;
> > +}
> > +
> > +static unsigned long ov5648_mode_mipi_clk_rate(struct ov5648_sensor *sensor,
> > + const struct ov5648_mode *mode,
> > + u32 mbus_code)
> > +{
> > + const struct ov5648_pll1_config *config;
> > + unsigned long pll1_rate;
> > +
> > + switch (mbus_code) {
> > + case MEDIA_BUS_FMT_SBGGR8_1X8:
> > + config = mode->pll1_config[0];
> > + break;
> > + case MEDIA_BUS_FMT_SBGGR10_1X10:
> > + config = mode->pll1_config[1];
> > + break;
> > + default:
> > + return 0;
> > + }
> > +
> > + pll1_rate = ov5648_mode_pll1_rate(sensor, config);
> > +
> > + return pll1_rate / config->sys_div / config->mipi_div / 2;
> > +}
> > +
> > +/* Exposure */
> > +
> > +static int ov5648_exposure_auto_configure(struct ov5648_sensor *sensor,
> > + bool enable)
> > +{
> > + return ov5648_update_bits(sensor, OV5648_MANUAL_CTRL_REG,
> > + OV5648_MANUAL_CTRL_AEC_MANUAL_EN,
> > + enable ? 0 : OV5648_MANUAL_CTRL_AEC_MANUAL_EN);
> > +}
> > +
> > +static int ov5648_exposure_configure(struct ov5648_sensor *sensor, u32 exposure)
> > +{
> > + struct ov5648_ctrls *ctrls = &sensor->ctrls;
> > + int ret;
> > +
> > + if (ctrls->exposure_auto->val != V4L2_EXPOSURE_MANUAL)
> > + return -EINVAL;
> > +
> > + ret = ov5648_write(sensor, OV5648_EXPOSURE_CTRL_HH_REG,
> > + OV5648_EXPOSURE_CTRL_HH(exposure));
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_EXPOSURE_CTRL_H_REG,
> > + OV5648_EXPOSURE_CTRL_H(exposure));
> > + if (ret)
> > + return ret;
> > +
> > + return ov5648_write(sensor, OV5648_EXPOSURE_CTRL_L_REG,
> > + OV5648_EXPOSURE_CTRL_L(exposure));
> > +}
> > +
> > +static int ov5648_exposure_value(struct ov5648_sensor *sensor,
> > + u32 *exposure)
> > +{
> > + u8 exposure_hh = 0, exposure_h = 0, exposure_l = 0;
> > + int ret;
> > +
> > + ret = ov5648_read(sensor, OV5648_EXPOSURE_CTRL_HH_REG, &exposure_hh);
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_read(sensor, OV5648_EXPOSURE_CTRL_H_REG, &exposure_h);
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_read(sensor, OV5648_EXPOSURE_CTRL_L_REG, &exposure_l);
> > + if (ret)
> > + return ret;
> > +
> > + *exposure = OV5648_EXPOSURE_CTRL_HH_VALUE((u32)exposure_hh) |
> > + OV5648_EXPOSURE_CTRL_H_VALUE((u32)exposure_h) |
> > + OV5648_EXPOSURE_CTRL_L_VALUE((u32)exposure_l);
> > +
> > + return 0;
> > +}
> > +
> > +/* Gain */
> > +
> > +static int ov5648_gain_auto_configure(struct ov5648_sensor *sensor, bool enable)
> > +{
> > + return ov5648_update_bits(sensor, OV5648_MANUAL_CTRL_REG,
> > + OV5648_MANUAL_CTRL_AGC_MANUAL_EN,
> > + enable ? 0 : OV5648_MANUAL_CTRL_AGC_MANUAL_EN);
> > +}
> > +
> > +static int ov5648_gain_configure(struct ov5648_sensor *sensor, u32 gain)
> > +{
> > + struct ov5648_ctrls *ctrls = &sensor->ctrls;
> > + int ret;
> > +
> > + if (ctrls->gain_auto->val)
> > + return -EINVAL;
> > +
> > + ret = ov5648_write(sensor, OV5648_GAIN_CTRL_H_REG,
> > + OV5648_GAIN_CTRL_H(gain));
> > + if (ret)
> > + return ret;
> > +
> > + return ov5648_write(sensor, OV5648_GAIN_CTRL_L_REG,
> > + OV5648_GAIN_CTRL_L(gain));
> > +}
> > +
> > +static int ov5648_gain_value(struct ov5648_sensor *sensor, u32 *gain)
> > +{
> > + u8 gain_h = 0, gain_l = 0;
> > + int ret;
> > +
> > + ret = ov5648_read(sensor, OV5648_GAIN_CTRL_H_REG, &gain_h);
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_read(sensor, OV5648_GAIN_CTRL_L_REG, &gain_l);
> > + if (ret)
> > + return ret;
> > +
> > + *gain = OV5648_GAIN_CTRL_H_VALUE((u32)gain_h) |
> > + OV5648_GAIN_CTRL_L_VALUE((u32)gain_l);
> > +
> > + return 0;
> > +}
> > +
> > +/* White Balance */
> > +
> > +static int ov5648_white_balance_auto_configure(struct ov5648_sensor *sensor,
> > + bool enable)
> > +{
> > + return ov5648_write(sensor, OV5648_AWB_CTRL_REG,
> > + enable ? 0 : OV5648_AWB_CTRL_GAIN_MANUAL_EN);
> > +}
> > +
> > +static int ov5648_white_balance_configure(struct ov5648_sensor *sensor,
> > + u32 red_balance, u32 blue_balance)
> > +{
> > + struct ov5648_ctrls *ctrls = &sensor->ctrls;
> > + int ret;
> > +
> > + if (ctrls->white_balance_auto->val)
> > + return -EINVAL;
> > +
> > + ret = ov5648_write(sensor, OV5648_GAIN_RED_MAN_H_REG,
> > + OV5648_GAIN_RED_MAN_H(red_balance));
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_GAIN_RED_MAN_L_REG,
> > + OV5648_GAIN_RED_MAN_L(red_balance));
> > + if (ret)
> > + return ret;
> > +
> > + ret = ov5648_write(sensor, OV5648_GAIN_BLUE_MAN_H_REG,
> > + OV5648_GAIN_BLUE_MAN_H(blue_balance));
> > + if (ret)
> > + return ret;
> > +
> > + return ov5648_write(sensor, OV5648_GAIN_BLUE_MAN_L_REG,
> > + OV5648_GAIN_BLUE_MAN_L(blue_balance));
> > +}
> > +
> > +/* Flip */
> > +
> > +static int ov5648_flip_vert_configure(struct ov5648_sensor *sensor, bool enable)
> > +{
> > + u8 bits = OV5648_TC20_FLIP_VERT_ISP_EN |
> > + OV5648_TC20_FLIP_VERT_SENSOR_EN;
> > +
> > + return ov5648_update_bits(sensor, OV5648_TC20_REG, bits,
> > + enable ? bits : 0);
> > +}
> > +
> > +static int ov5648_flip_horz_configure(struct ov5648_sensor *sensor, bool enable)
> > +{
> > + u8 bits = OV5648_TC21_FLIP_HORZ_ISP_EN |
> > + OV5648_TC21_FLIP_HORZ_SENSOR_EN;
> > +
> > + return ov5648_update_bits(sensor, OV5648_TC21_REG, bits,
> > + enable ? bits : 0);
> > +}
> > +
> > +/* Test Pattern */
> > +
> > +static int ov5648_test_pattern_configure(struct ov5648_sensor *sensor,
> > + unsigned int index)
> > +{
> > + if (index >= ARRAY_SIZE(ov5648_test_pattern_bits))
> > + return -EINVAL;
> > +
> > + return ov5648_write(sensor, OV5648_ISP_CTRL3D_REG,
> > + ov5648_test_pattern_bits[index]);
> > +}
> > +
> > +/* State */
> > +
> > +static int ov5648_state_mipi_configure(struct ov5648_sensor *sensor,
> > + const struct ov5648_mode *mode,
> > + u32 mbus_code)
> > +{
> > + struct ov5648_ctrls *ctrls = &sensor->ctrls;
> > + struct v4l2_fwnode_bus_mipi_csi2 *bus_mipi_csi2 =
> > + &sensor->endpoint.bus.mipi_csi2;
> > + unsigned long mipi_clk_rate;
> > + unsigned int bits_per_sample;
> > + unsigned int lanes_count;
> > + unsigned int i, j;
> > + s64 mipi_pixel_rate;
> > +
> > + mipi_clk_rate = ov5648_mode_mipi_clk_rate(sensor, mode, mbus_code);
> > + if (!mipi_clk_rate)
> > + return -EINVAL;
> > +
> > + for (i = 0; i < ARRAY_SIZE(ov5648_link_freq_menu); i++) {
> > + s64 freq = ov5648_link_freq_menu[i];
> > +
> > + if (freq == mipi_clk_rate)
> > + break;
> > + }
> > +
> > + for (j = 0; j < sensor->endpoint.nr_of_link_frequencies; j++) {
> > + u64 freq = sensor->endpoint.link_frequencies[j];
> > +
> > + if (freq == mipi_clk_rate)
> > + break;
> > + }
> > +
> > + if (i == ARRAY_SIZE(ov5648_link_freq_menu)) {
> > + dev_err(sensor->dev,
> > + "failed to find %lu clk rate in link freq\n",
> > + mipi_clk_rate);
> > + } else if (j == sensor->endpoint.nr_of_link_frequencies) {
> > + dev_err(sensor->dev,
> > + "failed to find %lu clk rate in endpoint link-frequencies\n",
> > + mipi_clk_rate);
> > + } else {
> > + __v4l2_ctrl_s_ctrl(ctrls->link_freq, i);
> > + }
> > +
> > + switch (mbus_code) {
> > + case MEDIA_BUS_FMT_SBGGR8_1X8:
> > + bits_per_sample = 8;
> > + break;
> > + case MEDIA_BUS_FMT_SBGGR10_1X10:
> > + bits_per_sample = 10;
> > + break;
> > + default:
> > + return -EINVAL;
> > + }
> > +
> > + lanes_count = bus_mipi_csi2->num_data_lanes;
> > + mipi_pixel_rate = mipi_clk_rate * 2 * lanes_count / bits_per_sample;
> > +
> > + __v4l2_ctrl_s_ctrl_int64(ctrls->pixel_rate, mipi_pixel_rate);
> > +
> > + return 0;
> > +}
> > +
> > +static int ov5648_state_configure(struct ov5648_sensor *sensor,
> > + const struct ov5648_mode *mode,
> > + u32 mbus_code)
> > +{
> > + int ret;
> > +
> > + if (sensor->state.streaming)
> > + return -EBUSY;
> > +
> > + /* State will be configured at first power on otherwise. */
> > + if (pm_runtime_enabled(sensor->dev) &&
> > + !pm_runtime_suspended(sensor->dev)) {
> > + ret = ov5648_mode_configure(sensor, mode, mbus_code);
> > + if (ret)
> > + return ret;
> > + }
> > +
> > + ret = ov5648_state_mipi_configure(sensor, mode, mbus_code);
> > + if (ret)
> > + return ret;
> > +
> > + sensor->state.mode = mode;
> > + sensor->state.mbus_code = mbus_code;
> > +
> > + return 0;
> > +}
> > +
> > +static int ov5648_state_init(struct ov5648_sensor *sensor)
> > +{
> > + return ov5648_state_configure(sensor, &ov5648_modes[0],
> > + ov5648_mbus_codes[0]);
> > +}
> > +
> > +/* Sensor Base */
> > +
> > +static int ov5648_sensor_init(struct ov5648_sensor *sensor)
> > +{
> > + int ret;
> > +
> > + ret = ov5648_sw_reset(sensor);
> > + if (ret) {
> > + dev_err(sensor->dev, "failed to perform sw reset\n");
> > + return ret;
> > + }
> > +
> > + ret = ov5648_sw_standby(sensor, 1);
> > + if (ret) {
> > + dev_err(sensor->dev, "failed to set sensor standby\n");
> > + return ret;
> > + }
> > +
> > + ret = ov5648_chip_id_check(sensor);
> > + if (ret) {
> > + dev_err(sensor->dev, "failed to check sensor chip id\n");
> > + return ret;
> > + }
> > +
> > + ret = ov5648_avdd_internal_power(sensor, !sensor->avdd);
> > + if (ret) {
> > + dev_err(sensor->dev, "failed to set internal avdd power\n");
> > + return ret;
> > + }
> > +
> > + ret = ov5648_write_sequence(sensor, ov5648_init_sequence,
> > + ARRAY_SIZE(ov5648_init_sequence));
> > + if (ret) {
> > + dev_err(sensor->dev, "failed to write init sequence\n");
> > + return ret;
> > + }
> > +
> > + ret = ov5648_pad_configure(sensor);
> > + if (ret) {
> > + dev_err(sensor->dev, "failed to configure pad\n");
> > + return ret;
> > + }
> > +
> > + ret = ov5648_mipi_configure(sensor);
> > + if (ret) {
> > + dev_err(sensor->dev, "failed to configure MIPI\n");
> > + return ret;
> > + }
> > +
> > + ret = ov5648_isp_configure(sensor);
> > + if (ret) {
> > + dev_err(sensor->dev, "failed to configure ISP\n");
> > + return ret;
> > + }
> > +
> > + ret = ov5648_black_level_configure(sensor);
> > + if (ret) {
> > + dev_err(sensor->dev, "failed to configure black level\n");
> > + return ret;
> > + }
> > +
> > + /* Configure current mode. */
> > + ret = ov5648_state_configure(sensor, sensor->state.mode,
> > + sensor->state.mbus_code);
> > + if (ret) {
> > + dev_err(sensor->dev, "failed to configure state\n");
> > + return ret;
> > + }
> > +
> > + return 0;
> > +}
> > +
> > +static int ov5648_sensor_power(struct ov5648_sensor *sensor, bool on)
> > +{
> > + /* Keep initialized to zero for disable label. */
> > + int ret = 0;
> > +
> > + /*
> > + * General notes about the power sequence:
> > + * - power-down GPIO must be active (low) during power-on;
> > + * - reset GPIO state does not matter during power-on;
> > + * - XVCLK must be provided 1 ms before register access;
> > + * - 10 ms are needed between power-down deassert and register access.
> > + */
> > +
> > + /* Note that regulator-and-GPIO-based power is untested. */
> > + if (on) {
> > + gpiod_set_value_cansleep(sensor->reset, 1);
> > + gpiod_set_value_cansleep(sensor->powerdown, 1);
> > +
> > + ret = regulator_enable(sensor->dovdd);
> > + if (ret) {
> > + dev_err(sensor->dev,
> > + "failed to enable DOVDD regulator\n");
> > + goto disable;
> > + }
> > +
> > + if (sensor->avdd) {
> > + ret = regulator_enable(sensor->avdd);
> > + if (ret) {
> > + dev_err(sensor->dev,
> > + "failed to enable AVDD regulator\n");
> > + goto disable;
> > + }
> > + }
> > +
> > + ret = regulator_enable(sensor->dvdd);
> > + if (ret) {
> > + dev_err(sensor->dev,
> > + "failed to enable DVDD regulator\n");
> > + goto disable;
> > + }
> > +
> > + /* According to OV5648 power up diagram. */
> > + usleep_range(5000, 10000);
> > +
> > + ret = clk_prepare_enable(sensor->xvclk);
> > + if (ret) {
> > + dev_err(sensor->dev, "failed to enable XVCLK clock\n");
> > + goto disable;
> > + }
> > +
> > + gpiod_set_value_cansleep(sensor->reset, 0);
> > + gpiod_set_value_cansleep(sensor->powerdown, 0);
> > +
> > + usleep_range(20000, 25000);
> > + } else {
> > +disable:
> > + gpiod_set_value_cansleep(sensor->powerdown, 1);
> > + gpiod_set_value_cansleep(sensor->reset, 1);
> > +
> > + clk_disable_unprepare(sensor->xvclk);
> > +
> > + regulator_disable(sensor->dvdd);
> > +
> > + if (sensor->avdd)
> > + regulator_disable(sensor->avdd);
> > +
> > + regulator_disable(sensor->dovdd);
> > + }
> > +
> > + return ret;
> > +}
> > +
> > +/* Controls */
> > +
> > +static int ov5648_g_volatile_ctrl(struct v4l2_ctrl *ctrl)
> > +{
> > + struct v4l2_subdev *subdev = ov5648_ctrl_subdev(ctrl);
> > + struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
> > + struct ov5648_ctrls *ctrls = &sensor->ctrls;
> > + int ret;
> > +
> > + switch (ctrl->id) {
> > + case V4L2_CID_EXPOSURE_AUTO:
> > + ret = ov5648_exposure_value(sensor, &ctrls->exposure->val);
> > + if (ret)
> > + return ret;
> > + break;
> > + case V4L2_CID_AUTOGAIN:
> > + ret = ov5648_gain_value(sensor, &ctrls->gain->val);
> > + if (ret)
> > + return ret;
> > + break;
> > + default:
> > + return -EINVAL;
> > + }
> > +
> > + return 0;
> > +}
> > +
> > +static int ov5648_s_ctrl(struct v4l2_ctrl *ctrl)
> > +{
> > + struct v4l2_subdev *subdev = ov5648_ctrl_subdev(ctrl);
> > + struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
> > + struct ov5648_ctrls *ctrls = &sensor->ctrls;
> > + unsigned int index;
> > + bool enable;
> > + int ret;
> > +
> > + /* Wait for the sensor to be on before setting controls. */
> > + if (pm_runtime_suspended(sensor->dev))
> > + return 0;
> > +
> > + switch (ctrl->id) {
> > + case V4L2_CID_EXPOSURE_AUTO:
> > + enable = ctrl->val == V4L2_EXPOSURE_AUTO;
> > +
> > + ret = ov5648_exposure_auto_configure(sensor, enable);
> > + if (ret)
> > + return ret;
> > +
> > + if (!enable && ctrls->exposure->is_new) {
> > + ret = ov5648_exposure_configure(sensor,
> > + ctrls->exposure->val);
> > + if (ret)
> > + return ret;
> > + }
> > + break;
> > + case V4L2_CID_AUTOGAIN:
> > + enable = !!ctrl->val;
> > +
> > + ret = ov5648_gain_auto_configure(sensor, enable);
> > + if (ret)
> > + return ret;
> > +
> > + if (!enable) {
> > + ret = ov5648_gain_configure(sensor, ctrls->gain->val);
> > + if (ret)
> > + return ret;
> > + }
> > + break;
> > + case V4L2_CID_AUTO_WHITE_BALANCE:
> > + enable = !!ctrl->val;
> > +
> > + ret = ov5648_white_balance_auto_configure(sensor, enable);
> > + if (ret)
> > + return ret;
> > +
> > + if (!enable) {
> > + ret = ov5648_white_balance_configure(sensor,
> > + ctrls->red_balance->val,
> > + ctrls->blue_balance->val);
> > + if (ret)
> > + return ret;
> > + }
> > + break;
> > + case V4L2_CID_HFLIP:
> > + enable = !!ctrl->val;
> > + return ov5648_flip_horz_configure(sensor, enable);
> > + case V4L2_CID_VFLIP:
> > + enable = !!ctrl->val;
> > + return ov5648_flip_vert_configure(sensor, enable);
> > + case V4L2_CID_TEST_PATTERN:
> > + index = (unsigned int)ctrl->val;
> > + return ov5648_test_pattern_configure(sensor, index);
> > + default:
> > + return -EINVAL;
> > + }
> > +
> > + return 0;
> > +}
> > +
> > +static const struct v4l2_ctrl_ops ov5648_ctrl_ops = {
> > + .g_volatile_ctrl = ov5648_g_volatile_ctrl,
> > + .s_ctrl = ov5648_s_ctrl,
> > +};
> > +
> > +static int ov5648_ctrls_init(struct ov5648_sensor *sensor)
> > +{
> > + struct ov5648_ctrls *ctrls = &sensor->ctrls;
> > + struct v4l2_ctrl_handler *handler = &ctrls->handler;
> > + const struct v4l2_ctrl_ops *ops = &ov5648_ctrl_ops;
> > + int ret;
> > +
> > + v4l2_ctrl_handler_init(handler, 32);
> > +
> > + /* Use our mutex for ctrl locking. */
> > + handler->lock = &sensor->mutex;
> > +
> > + /* Exposure */
> > +
> > + ctrls->exposure_auto = v4l2_ctrl_new_std_menu(handler, ops,
> > + V4L2_CID_EXPOSURE_AUTO,
> > + V4L2_EXPOSURE_MANUAL, 0,
> > + V4L2_EXPOSURE_AUTO);
> > +
> > + ctrls->exposure = v4l2_ctrl_new_std(handler, ops, V4L2_CID_EXPOSURE,
> > + 16, 1048575, 16, 512);
> > + ctrls->exposure->flags |= V4L2_CTRL_FLAG_VOLATILE;
>
> ctrls->exposure may be NULL here.
>
> I'd move this after the handler's error check.
>
> > +
> > + v4l2_ctrl_auto_cluster(2, &ctrls->exposure_auto, 1, true);
> > +
> > + /* Gain */
> > +
> > + ctrls->gain_auto =
> > + v4l2_ctrl_new_std(handler, ops, V4L2_CID_AUTOGAIN, 0, 1, 1, 1);
> > +
> > + ctrls->gain = v4l2_ctrl_new_std(handler, ops, V4L2_CID_GAIN, 16, 1023,
> > + 16, 16);
> > + ctrls->gain->flags |= V4L2_CTRL_FLAG_VOLATILE;
>
> Ditto.
>
> > +
> > + v4l2_ctrl_auto_cluster(2, &ctrls->gain_auto, 0, true);
> > +
> > + /* White Balance */
> > +
> > + ctrls->white_balance_auto =
> > + v4l2_ctrl_new_std(handler, ops, V4L2_CID_AUTO_WHITE_BALANCE, 0,
> > + 1, 1, 1);
> > +
> > + ctrls->red_balance = v4l2_ctrl_new_std(handler, ops,
> > + V4L2_CID_RED_BALANCE, 0, 4095,
> > + 1, 1024);
> > +
> > + ctrls->blue_balance = v4l2_ctrl_new_std(handler, ops,
> > + V4L2_CID_BLUE_BALANCE, 0, 4095,
> > + 1, 1024);
> > +
> > + v4l2_ctrl_auto_cluster(3, &ctrls->white_balance_auto, 0, false);
> > +
> > + /* Flip */
> > +
> > + v4l2_ctrl_new_std(handler, ops, V4L2_CID_HFLIP, 0, 1, 1, 0);
> > + v4l2_ctrl_new_std(handler, ops, V4L2_CID_VFLIP, 0, 1, 1, 0);
> > +
> > + /* Test Pattern */
> > +
> > + v4l2_ctrl_new_std_menu_items(handler, ops, V4L2_CID_TEST_PATTERN,
> > + ARRAY_SIZE(ov5648_test_pattern_menu) - 1,
> > + 0, 0, ov5648_test_pattern_menu);
> > +
> > + /* MIPI CSI-2 */
> > +
> > + ctrls->link_freq =
> > + v4l2_ctrl_new_int_menu(handler, NULL, V4L2_CID_LINK_FREQ,
> > + ARRAY_SIZE(ov5648_link_freq_menu) - 1,
> > + 0, ov5648_link_freq_menu);
> > +
> > + ctrls->link_freq->flags |= V4L2_CTRL_FLAG_READ_ONLY;
>
> Ditto.
>
> > +
> > + ctrls->pixel_rate =
> > + v4l2_ctrl_new_std(handler, NULL, V4L2_CID_PIXEL_RATE, 1,
> > + INT_MAX, 1, 1);
> > +
> > + ctrls->pixel_rate->flags |= V4L2_CTRL_FLAG_READ_ONLY;
>
> Ditto.
>
> > +
> > + if (handler->error) {
> > + ret = handler->error;
> > + goto error_ctrls;
> > + }
> > +
> > + sensor->subdev.ctrl_handler = handler;
> > +
> > + return 0;
> > +
> > +error_ctrls:
> > + v4l2_ctrl_handler_free(handler);
> > +
> > + return ret;
> > +}
> > +
> > +/* Subdev Video Operations */
> > +
> > +static int ov5648_s_stream(struct v4l2_subdev *subdev, int enable)
> > +{
> > + struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
> > + struct ov5648_state *state = &sensor->state;
> > + int ret = 0;
>
> No need to initialise ret.
>
> > +
> > + if (enable) {
> > + ret = pm_runtime_get_sync(sensor->dev);
> > + if (ret < 0) {
> > + pm_runtime_put_noidle(sensor->dev);
> > + return ret;
> > + }
> > + }
> > +
> > + mutex_lock(&sensor->mutex);
> > + ret = ov5648_sw_standby(sensor, !enable);
> > + mutex_unlock(&sensor->mutex);
> > +
> > + if (ret)
> > + return ret;
> > +
> > + state->streaming = !!enable;
> > +
> > + if (!enable)
> > + pm_runtime_put(sensor->dev);
> > +
> > + return 0;
> > +}
> > +
> > +static int ov5648_g_frame_interval(struct v4l2_subdev *subdev,
> > + struct v4l2_subdev_frame_interval *interval)
> > +{
> > + struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
> > + const struct ov5648_mode *mode;
> > + int ret = 0;
> > +
> > + mutex_lock(&sensor->mutex);
> > +
> > + mode = sensor->state.mode;
> > +
> > + switch (sensor->state.mbus_code) {
> > + case MEDIA_BUS_FMT_SBGGR8_1X8:
> > + interval->interval = mode->frame_interval[0];
> > + break;
> > + case MEDIA_BUS_FMT_SBGGR10_1X10:
> > + interval->interval = mode->frame_interval[1];
> > + break;
> > + default:
> > + ret = -EINVAL;
> > + }
> > +
> > + mutex_unlock(&sensor->mutex);
> > +
> > + return ret;
> > +}
> > +
> > +static const struct v4l2_subdev_video_ops ov5648_subdev_video_ops = {
> > + .s_stream = ov5648_s_stream,
> > + .g_frame_interval = ov5648_g_frame_interval,
> > + .s_frame_interval = ov5648_g_frame_interval,
> > +};
> > +
> > +/* Subdev Pad Operations */
> > +
> > +static int ov5648_enum_mbus_code(struct v4l2_subdev *subdev,
> > + struct v4l2_subdev_pad_config *config,
> > + struct v4l2_subdev_mbus_code_enum *code_enum)
> > +{
> > + if (code_enum->index >= ARRAY_SIZE(ov5648_mbus_codes))
> > + return -EINVAL;
> > +
> > + code_enum->code = ov5648_mbus_codes[code_enum->index];
> > +
> > + return 0;
> > +}
> > +
> > +static void ov5648_mbus_format_fill(struct v4l2_mbus_framefmt *mbus_format,
> > + u32 mbus_code,
> > + const struct ov5648_mode *mode)
> > +{
> > + mbus_format->width = mode->output_size_x;
> > + mbus_format->height = mode->output_size_y;
> > + mbus_format->code = mbus_code;
> > +
> > + mbus_format->field = V4L2_FIELD_NONE;
> > + mbus_format->colorspace = V4L2_COLORSPACE_RAW;
> > + mbus_format->ycbcr_enc =
> > + V4L2_MAP_YCBCR_ENC_DEFAULT(mbus_format->colorspace);
> > + mbus_format->quantization = V4L2_QUANTIZATION_FULL_RANGE;
> > + mbus_format->xfer_func =
> > + V4L2_MAP_XFER_FUNC_DEFAULT(mbus_format->colorspace);
> > +}
> > +
> > +static int ov5648_get_fmt(struct v4l2_subdev *subdev,
> > + struct v4l2_subdev_pad_config *config,
> > + struct v4l2_subdev_format *format)
> > +{
> > + struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
> > + struct v4l2_mbus_framefmt *mbus_format = &format->format;
> > +
> > + mutex_lock(&sensor->mutex);
> > +
> > + if (format->which == V4L2_SUBDEV_FORMAT_TRY)
> > + *mbus_format = *v4l2_subdev_get_try_format(subdev, config,
> > + format->pad);
> > + else
> > + ov5648_mbus_format_fill(mbus_format, sensor->state.mbus_code,
> > + sensor->state.mode);
> > +
> > + mutex_unlock(&sensor->mutex);
> > +
> > + return 0;
> > +}
> > +
> > +static int ov5648_set_fmt(struct v4l2_subdev *subdev,
> > + struct v4l2_subdev_pad_config *config,
> > + struct v4l2_subdev_format *format)
> > +{
> > + struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
> > + struct v4l2_mbus_framefmt *mbus_format = &format->format;
> > + const struct ov5648_mode *mode;
> > + u32 mbus_code = 0;
> > + unsigned int index;
> > + int ret = 0;
> > +
> > + mutex_lock(&sensor->mutex);
> > +
> > + if (sensor->state.streaming) {
> > + ret = -EBUSY;
> > + goto complete;
> > + }
> > +
> > + /* Try to find requested mbus code. */
> > + for (index = 0; index < ARRAY_SIZE(ov5648_mbus_codes); index++) {
> > + if (ov5648_mbus_codes[index] == mbus_format->code) {
> > + mbus_code = mbus_format->code;
> > + break;
> > + }
> > + }
> > +
> > + /* Fallback to default. */
> > + if (!mbus_code)
> > + mbus_code = ov5648_mbus_codes[0];
> > +
> > + /* Find the mode with nearest dimensions. */
> > + mode = v4l2_find_nearest_size(ov5648_modes, ARRAY_SIZE(ov5648_modes),
> > + output_size_x, output_size_y,
> > + mbus_format->width, mbus_format->height);
> > + if (!mode)
>
> mutex is held here.
>
> > + return -EINVAL;
> > +
> > + ov5648_mbus_format_fill(mbus_format, mbus_code, mode);
> > +
> > + if (format->which == V4L2_SUBDEV_FORMAT_TRY) {
> > + *v4l2_subdev_get_try_format(subdev, config, format->pad) =
> > + *mbus_format;
> > + } else if (sensor->state.mode != mode ||
> > + sensor->state.mbus_code != mbus_code) {
> > + ret = ov5648_state_configure(sensor, mode, mbus_code);
> > + if (ret)
> > + goto complete;
>
> The goto has no effect here.
>
> > + }
> > +
> > +complete:
> > + mutex_unlock(&sensor->mutex);
> > +
> > + return ret;
> > +}
> > +
> > +static int ov5648_enum_frame_size(struct v4l2_subdev *subdev,
> > + struct v4l2_subdev_pad_config *config,
> > + struct v4l2_subdev_frame_size_enum *size_enum)
> > +{
> > + const struct ov5648_mode *mode;
> > +
> > + if (size_enum->index >= ARRAY_SIZE(ov5648_modes))
> > + return -EINVAL;
> > +
> > + mode = &ov5648_modes[size_enum->index];
> > +
> > + size_enum->min_width = size_enum->max_width = mode->output_size_x;
> > + size_enum->min_height = size_enum->max_height = mode->output_size_y;
> > +
> > + return 0;
> > +}
> > +
> > +static int ov5648_enum_frame_interval(struct v4l2_subdev *subdev,
> > + struct v4l2_subdev_pad_config *config,
> > + struct v4l2_subdev_frame_interval_enum *interval_enum)
> > +{
> > + const struct ov5648_mode *mode = NULL;
> > + unsigned int mode_index;
> > + unsigned int interval_index;
> > +
> > + if (interval_enum->index > 0)
> > + return -EINVAL;
> > +
> > + /*
> > + * Multiple modes with the same dimensions may have different frame
> > + * intervals, so look up each relevant mode.
> > + */
> > + for (mode_index = 0, interval_index = 0;
> > + mode_index < ARRAY_SIZE(ov5648_modes); mode_index++) {
> > + mode = &ov5648_modes[mode_index];
> > +
> > + if (mode->output_size_x == interval_enum->width &&
> > + mode->output_size_y == interval_enum->height) {
> > + if (interval_index == interval_enum->index)
> > + break;
> > +
> > + interval_index++;
> > + }
> > + }
> > +
> > + if (mode_index == ARRAY_SIZE(ov5648_modes) || !mode)
> > + return -EINVAL;
> > +
> > + switch (interval_enum->code) {
> > + case MEDIA_BUS_FMT_SBGGR8_1X8:
> > + interval_enum->interval = mode->frame_interval[0];
> > + break;
> > + case MEDIA_BUS_FMT_SBGGR10_1X10:
> > + interval_enum->interval = mode->frame_interval[1];
> > + break;
> > + default:
> > + return -EINVAL;
> > + }
> > +
> > + return 0;
> > +}
> > +
> > +static const struct v4l2_subdev_pad_ops ov5648_subdev_pad_ops = {
> > + .enum_mbus_code = ov5648_enum_mbus_code,
> > + .get_fmt = ov5648_get_fmt,
> > + .set_fmt = ov5648_set_fmt,
> > + .enum_frame_size = ov5648_enum_frame_size,
> > + .enum_frame_interval = ov5648_enum_frame_interval,
> > +};
> > +
> > +static const struct v4l2_subdev_ops ov5648_subdev_ops = {
> > + .video = &ov5648_subdev_video_ops,
> > + .pad = &ov5648_subdev_pad_ops,
> > +};
> > +
> > +static int ov5648_suspend(struct device *dev)
> > +{
> > + struct i2c_client *client = to_i2c_client(dev);
> > + struct v4l2_subdev *subdev = i2c_get_clientdata(client);
> > + struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
> > + struct ov5648_state *state = &sensor->state;
> > + int ret = 0;
> > +
> > + mutex_lock(&sensor->mutex);
> > +
> > + if (state->streaming) {
> > + ret = ov5648_sw_standby(sensor, true);
> > + if (ret)
> > + goto complete;
> > + }
> > +
> > + ret = ov5648_sensor_power(sensor, false);
> > + if (ret) {
> > + ov5648_sw_standby(sensor, false);
> > + goto complete;
>
> No need for goto.
>
> > + }
> > +
> > +complete:
> > + mutex_unlock(&sensor->mutex);
> > +
> > + return ret;
> > +}
> > +
> > +static int ov5648_resume(struct device *dev)
> > +{
> > + struct i2c_client *client = to_i2c_client(dev);
> > + struct v4l2_subdev *subdev = i2c_get_clientdata(client);
> > + struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
> > + struct ov5648_state *state = &sensor->state;
> > + int ret = 0;
> > +
> > + mutex_lock(&sensor->mutex);
> > +
> > + ret = ov5648_sensor_power(sensor, true);
> > + if (ret)
> > + goto complete;
> > +
> > + ret = ov5648_sensor_init(sensor);
> > + if (ret)
> > + goto error_power;
> > +
> > + ret = __v4l2_ctrl_handler_setup(&sensor->ctrls.handler);
> > + if (ret)
> > + goto error_power;
> > +
> > + if (state->streaming) {
> > + ret = ov5648_sw_standby(sensor, false);
> > + if (ret)
> > + goto error_power;
> > + }
> > +
> > + goto complete;
>
> This isn't really wrong, but the code might be easier to read if you
> unlocked the mutex here and returned zero.
>
> > +
> > +error_power:
> > + ov5648_sensor_power(sensor, false);
> > +
> > +complete:
> > + mutex_unlock(&sensor->mutex);
> > +
> > + return ret;
> > +}
> > +
> > +static int ov5648_probe(struct i2c_client *client)
> > +{
> > + struct device *dev = &client->dev;
> > + struct fwnode_handle *handle;
> > + struct ov5648_sensor *sensor;
> > + struct v4l2_subdev *subdev;
> > + struct media_pad *pad;
> > + unsigned long rate;
> > + int ret;
> > +
> > + sensor = devm_kzalloc(dev, sizeof(*sensor), GFP_KERNEL);
> > + if (!sensor)
> > + return -ENOMEM;
> > +
> > + sensor->dev = dev;
> > + sensor->i2c_client = client;
> > +
> > + /* Graph Endpoint */
> > +
> > + handle = fwnode_graph_get_next_endpoint(dev_fwnode(dev), NULL);
> > + if (!handle) {
> > + dev_err(dev, "unable to find enpoint node\n");
> > + return -EINVAL;
> > + }
> > +
> > + sensor->endpoint.bus_type = V4L2_MBUS_CSI2_DPHY;
> > +
> > + ret = v4l2_fwnode_endpoint_alloc_parse(handle, &sensor->endpoint);
> > + fwnode_handle_put(handle);
> > + if (ret) {
> > + dev_err(dev, "failed to parse endpoint node\n");
> > + return ret;
> > + }
> > +
> > + /* GPIOs */
> > +
> > + sensor->powerdown = devm_gpiod_get_optional(dev, "powerdown",
> > + GPIOD_OUT_HIGH);
> > + if (IS_ERR(sensor->powerdown)) {
> > + ret = PTR_ERR(sensor->powerdown);
> > + goto error_endpoint;
> > + }
> > +
> > + sensor->reset = devm_gpiod_get_optional(dev, "reset", GPIOD_OUT_HIGH);
> > + if (IS_ERR(sensor->reset)) {
> > + ret = PTR_ERR(sensor->reset);
> > + goto error_endpoint;
> > + }
> > +
> > + /* Regulators */
> > +
> > + /* DVDD: digital core */
> > + sensor->dvdd = devm_regulator_get(dev, "dvdd");
> > + if (IS_ERR(sensor->dvdd)) {
> > + dev_err(dev, "cannot get DVDD (digital core) regulator\n");
> > + ret = PTR_ERR(sensor->dvdd);
> > + goto error_endpoint;
> > + }
> > +
> > + /* DOVDD: digital I/O */
> > + sensor->dovdd = devm_regulator_get(dev, "dovdd");
> > + if (IS_ERR(sensor->dvdd)) {
> > + dev_err(dev, "cannot get DOVDD (digital I/O) regulator\n");
> > + ret = PTR_ERR(sensor->dvdd);
> > + goto error_endpoint;
> > + }
> > +
> > + /* AVDD: analog */
> > + sensor->avdd = devm_regulator_get_optional(dev, "avdd");
> > + if (IS_ERR(sensor->avdd)) {
> > + dev_info(dev, "no AVDD regulator provided, using internal\n");
> > + sensor->avdd = NULL;
> > + }
> > +
> > + /* External Clock */
> > +
> > + sensor->xvclk = devm_clk_get(dev, NULL);
> > + if (IS_ERR(sensor->xvclk)) {
> > + dev_err(dev, "failed to get external clock\n");
> > + ret = PTR_ERR(sensor->xvclk);
> > + goto error_endpoint;
> > + }
> > +
> > + rate = clk_get_rate(sensor->xvclk);
> > + if (rate != OV5648_XVCLK_RATE) {
> > + dev_err(dev, "clock rate %lu Hz is unsupported\n", rate);
> > + ret = -EINVAL;
> > + goto error_endpoint;
> > + }
> > +
> > + /* Subdev, entity and pad */
> > +
> > + subdev = &sensor->subdev;
> > + v4l2_i2c_subdev_init(subdev, client, &ov5648_subdev_ops);
> > +
> > + subdev->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
> > + subdev->entity.function = MEDIA_ENT_F_CAM_SENSOR;
> > +
> > + pad = &sensor->pad;
> > + pad->flags = MEDIA_PAD_FL_SOURCE;
> > +
> > + ret = media_entity_pads_init(&subdev->entity, 1, pad);
> > + if (ret)
> > + goto error_entity;
> > +
> > + /* Mutex */
> > +
> > + mutex_init(&sensor->mutex);
> > +
> > + /* Sensor */
> > +
> > + ret = ov5648_ctrls_init(sensor);
> > + if (ret)
> > + goto error_mutex;
> > +
> > + ret = ov5648_state_init(sensor);
> > + if (ret)
> > + goto error_ctrls;
> > +
> > + /* Runtime PM */
> > +
> > + pm_runtime_enable(sensor->dev);
> > + pm_runtime_set_suspended(sensor->dev);
> > +
> > + /* V4L2 subdev register */
> > +
> > + ret = v4l2_async_register_subdev_sensor_common(subdev);
> > + if (ret)
> > + goto error_pm;
> > +
> > + return 0;
> > +
> > +error_pm:
> > + pm_runtime_disable(sensor->dev);
> > +
> > +error_ctrls:
> > + v4l2_ctrl_handler_free(&sensor->ctrls.handler);
> > +
> > +error_mutex:
> > + mutex_destroy(&sensor->mutex);
> > +
> > +error_entity:
> > + media_entity_cleanup(&sensor->subdev.entity);
> > +
> > +error_endpoint:
> > + v4l2_fwnode_endpoint_free(&sensor->endpoint);
> > +
> > + return ret;
> > +}
> > +
> > +static int ov5648_remove(struct i2c_client *client)
> > +{
> > + struct v4l2_subdev *subdev = i2c_get_clientdata(client);
> > + struct ov5648_sensor *sensor = ov5648_subdev_sensor(subdev);
> > +
> > + v4l2_async_unregister_subdev(subdev);
> > + pm_runtime_disable(sensor->dev);
> > + v4l2_ctrl_handler_free(&sensor->ctrls.handler);
> > + mutex_destroy(&sensor->mutex);
> > + media_entity_cleanup(&subdev->entity);
> > + v4l2_device_unregister_subdev(subdev);
>
> This needs to be done only for subdevs registered using
> v4l2_device_register_subdev(), i.e. not here.
>
> > +
> > + return 0;
> > +}
> > +
> > +static const struct dev_pm_ops ov5648_pm_ops = {
> > + SET_RUNTIME_PM_OPS(ov5648_suspend, ov5648_resume, NULL)
> > +};
> > +
> > +static const struct of_device_id ov5648_of_match[] = {
> > + { .compatible = "ovti,ov5648" },
> > + { }
> > +};
> > +MODULE_DEVICE_TABLE(of, ov5648_of_match);
> > +
> > +static struct i2c_driver ov5648_driver = {
> > + .driver = {
> > + .name = "ov5648",
> > + .of_match_table = ov5648_of_match,
> > + .pm = &ov5648_pm_ops,
> > + },
> > + .probe_new = ov5648_probe,
> > + .remove = ov5648_remove,
> > +};
> > +
> > +module_i2c_driver(ov5648_driver);
> > +
> > +MODULE_AUTHOR("Paul Kocialkowski <paul.kocialkowski@bootlin.com>");
> > +MODULE_DESCRIPTION("V4L2 driver for the OmniVision OV5648 image sensor");
> > +MODULE_LICENSE("GPL v2");
>
> --
> Kind regards,
>
> Sakari Ailus
--
Paul Kocialkowski, Bootlin
Embedded Linux and kernel engineering
https://bootlin.com
[-- Attachment #2: signature.asc --]
[-- Type: application/pgp-signature, Size: 488 bytes --]
^ permalink raw reply [flat|nested] 5+ messages in thread
end of thread, other threads:[~2020-12-31 12:54 UTC | newest]
Thread overview: 5+ messages (download: mbox.gz / follow: Atom feed)
-- links below jump to the message on this page --
2020-12-11 15:40 [PATCH v5 0/2] media: i2c: OV5648 image sensor support Paul Kocialkowski
2020-12-11 15:40 ` [PATCH v5 1/2] dt-bindings: media: i2c: Add OV5648 bindings documentation Paul Kocialkowski
2020-12-11 15:40 ` [PATCH v5 2/2] media: i2c: Add support for the OV5648 image sensor Paul Kocialkowski
2020-12-20 22:39 ` Sakari Ailus
2020-12-31 12:53 ` Paul Kocialkowski
This is a public inbox, see mirroring instructions
for how to clone and mirror all data and code used for this inbox;
as well as URLs for NNTP newsgroup(s).