* [PATCH v3 0/5] Add support for the Hynix Hi-846 camera
@ 2021-05-31 12:07 Martin Kepplinger
2021-05-31 12:07 ` [PATCH v3 1/5] dt-bindings: vendor-prefixes: Add SK Hynix Inc Martin Kepplinger
` (4 more replies)
0 siblings, 5 replies; 14+ messages in thread
From: Martin Kepplinger @ 2021-05-31 12:07 UTC (permalink / raw)
To: pavel, krzysztof.kozlowski, laurent.pinchart, mchehab,
paul.kocialkowski, robh, shawnx.tu
Cc: devicetree, kernel, linux-kernel, linux-media, martin.kepplinger,
phone-devel
hi,
This patchset adds support for the SK Hynix Hi-846 CMOS images sensor.
It includes dt-bindings and the driver.
Patches 4 and 5 are basically optional: if i2c-cardlist is deprecated,
ignore it and act on it appropriately, and the arm64 defconfig is just
convenience for now.
(I again send v3 a bit early because the Intel kernel test robot still found
an error in v2)
best wishes,
martin
revision history
----------------
v3: (thank you, Laurent)
* use do_div() for divisions
* reset-gpios DT property name instead of rst-gpios
* improve the dt-bindings
* add the phone-devel list
v2:
sent a bit early due to stupid mistakes
fix build issues
fix dtschema issues
add enable for arm64 defconfig
https://lore.kernel.org/linux-media/20210530212337.GA15366@duo.ucw.cz/T/#t
v1:
https://lore.kernel.org/linux-media/20210527091221.3335998-1-martin.kepplinger@puri.sm/
Martin Kepplinger (5):
dt-bindings: vendor-prefixes: Add SK Hynix Inc.
dt-bindings: media: document SK Hynix Hi-846 MIPI CSI-2 8M pixel
sensor
media: i2c: add driver for the SK Hynix Hi-846 8M pixel camera
arm64: defconfig: enable VIDEO_HI846
Documentation: i2c-cardlist: add the Hynix hi846 sensor
.../admin-guide/media/i2c-cardlist.rst | 1 +
.../bindings/media/i2c/hynix,hi846.yaml | 99 +
.../devicetree/bindings/vendor-prefixes.yaml | 2 +
MAINTAINERS | 6 +
arch/arm64/configs/defconfig | 1 +
drivers/media/i2c/Kconfig | 13 +
drivers/media/i2c/Makefile | 1 +
drivers/media/i2c/hi846.c | 2138 +++++++++++++++++
8 files changed, 2261 insertions(+)
create mode 100644 Documentation/devicetree/bindings/media/i2c/hynix,hi846.yaml
create mode 100644 drivers/media/i2c/hi846.c
--
2.30.2
^ permalink raw reply [flat|nested] 14+ messages in thread* [PATCH v3 1/5] dt-bindings: vendor-prefixes: Add SK Hynix Inc. 2021-05-31 12:07 [PATCH v3 0/5] Add support for the Hynix Hi-846 camera Martin Kepplinger @ 2021-05-31 12:07 ` Martin Kepplinger 2021-06-02 19:23 ` Rob Herring 2021-05-31 12:07 ` [PATCH v3 2/5] dt-bindings: media: document SK Hynix Hi-846 MIPI CSI-2 8M pixel sensor Martin Kepplinger ` (3 subsequent siblings) 4 siblings, 1 reply; 14+ messages in thread From: Martin Kepplinger @ 2021-05-31 12:07 UTC (permalink / raw) To: pavel, krzysztof.kozlowski, laurent.pinchart, mchehab, paul.kocialkowski, robh, shawnx.tu Cc: devicetree, kernel, linux-kernel, linux-media, martin.kepplinger, phone-devel SK Hynix built the already supported hi556 sensor (and probably much more). For more information, see https://www.skhynix.com/ Signed-off-by: Martin Kepplinger <martin.kepplinger@puri.sm> --- Documentation/devicetree/bindings/vendor-prefixes.yaml | 2 ++ 1 file changed, 2 insertions(+) diff --git a/Documentation/devicetree/bindings/vendor-prefixes.yaml b/Documentation/devicetree/bindings/vendor-prefixes.yaml index b868cefc7c55..a75cd3be50b9 100644 --- a/Documentation/devicetree/bindings/vendor-prefixes.yaml +++ b/Documentation/devicetree/bindings/vendor-prefixes.yaml @@ -499,6 +499,8 @@ patternProperties: description: Hycon Technology Corp. "^hydis,.*": description: Hydis Technologies + "^hynix,.*": + description: SK Hynix Inc. "^hyundai,.*": description: Hyundai Technology "^i2se,.*": -- 2.30.2 ^ permalink raw reply related [flat|nested] 14+ messages in thread
* Re: [PATCH v3 1/5] dt-bindings: vendor-prefixes: Add SK Hynix Inc. 2021-05-31 12:07 ` [PATCH v3 1/5] dt-bindings: vendor-prefixes: Add SK Hynix Inc Martin Kepplinger @ 2021-06-02 19:23 ` Rob Herring 0 siblings, 0 replies; 14+ messages in thread From: Rob Herring @ 2021-06-02 19:23 UTC (permalink / raw) To: Martin Kepplinger Cc: laurent.pinchart, linux-media, krzysztof.kozlowski, pavel, devicetree, phone-devel, shawnx.tu, linux-kernel, mchehab, kernel, paul.kocialkowski On Mon, 31 May 2021 14:07:33 +0200, Martin Kepplinger wrote: > SK Hynix built the already supported hi556 sensor (and probably much > more). For more information, see https://www.skhynix.com/ > > Signed-off-by: Martin Kepplinger <martin.kepplinger@puri.sm> > --- > Documentation/devicetree/bindings/vendor-prefixes.yaml | 2 ++ > 1 file changed, 2 insertions(+) > Acked-by: Rob Herring <robh@kernel.org> ^ permalink raw reply [flat|nested] 14+ messages in thread
* [PATCH v3 2/5] dt-bindings: media: document SK Hynix Hi-846 MIPI CSI-2 8M pixel sensor 2021-05-31 12:07 [PATCH v3 0/5] Add support for the Hynix Hi-846 camera Martin Kepplinger 2021-05-31 12:07 ` [PATCH v3 1/5] dt-bindings: vendor-prefixes: Add SK Hynix Inc Martin Kepplinger @ 2021-05-31 12:07 ` Martin Kepplinger 2021-05-31 23:13 ` Laurent Pinchart 2021-05-31 12:07 ` [PATCH v3 3/5] media: i2c: add driver for the SK Hynix Hi-846 8M pixel camera Martin Kepplinger ` (2 subsequent siblings) 4 siblings, 1 reply; 14+ messages in thread From: Martin Kepplinger @ 2021-05-31 12:07 UTC (permalink / raw) To: pavel, krzysztof.kozlowski, laurent.pinchart, mchehab, paul.kocialkowski, robh, shawnx.tu Cc: devicetree, kernel, linux-kernel, linux-media, martin.kepplinger, phone-devel Document the bindings used for the SK Hynix Hi-846 CMOS camera driver. Signed-off-by: Martin Kepplinger <martin.kepplinger@puri.sm> --- .../bindings/media/i2c/hynix,hi846.yaml | 99 +++++++++++++++++++ 1 file changed, 99 insertions(+) create mode 100644 Documentation/devicetree/bindings/media/i2c/hynix,hi846.yaml diff --git a/Documentation/devicetree/bindings/media/i2c/hynix,hi846.yaml b/Documentation/devicetree/bindings/media/i2c/hynix,hi846.yaml new file mode 100644 index 000000000000..26462f6b5e69 --- /dev/null +++ b/Documentation/devicetree/bindings/media/i2c/hynix,hi846.yaml @@ -0,0 +1,99 @@ +# SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause) +%YAML 1.2 +--- +$id: http://devicetree.org/schemas/media/i2c/hynix,hi846.yaml# +$schema: http://devicetree.org/meta-schemas/core.yaml# + +title: SK Hynix Hi-846 1/4" 8M Pixel MIPI CSI-2 sensor + +maintainers: + - Martin Kepplinger <martin.kepplinger@puri.sm> + +description: |- + The Hi-846 is a raw image sensor with an MIPI CSI-2 image data + interface and CCI (I2C compatible) control bus. The output format + is 10bit Bayer. + +properties: + compatible: + const: hynix,hi846 + + reg: + maxItems: 1 + + clocks: + items: + - description: Reference to the mclk clock. + + clock-names: + items: + - const: mclk + + reset-gpios: + description: Reference to the GPIO connected to the reset pin. Active low. + maxItems: 1 + + vdd-supply: + description: Definition of the regulator used as 1.8V digital power supply. + + port: + $ref: /schemas/graph.yaml#/properties/port + additionalProperties: false + + properties: + endpoint: + $ref: /schemas/media/video-interfaces.yaml# + unevaluatedProperties: false + + properties: + data-lanes: + oneOf: + - items: + - const: 1 + - const: 2 + - const: 3 + - const: 4 + - items: + - const: 1 + - const: 2 + + required: + - data-lanes + +required: + - compatible + - reg + - clocks + - clock-names + - reset-gpios + - vdd-supply + - port + +additionalProperties: false + +examples: + - | + #include <dt-bindings/gpio/gpio.h> + + i2c { + #address-cells = <1>; + #size-cells = <0>; + + hi846: camera@20 { + compatible = "hynix,hi846"; + reg = <0x20>; + clocks = <&clk>; + clock-names = "mclk"; + vdd-supply = <®_camera_pwr_en>; /* 1.8v */ + reset-gpios = <&gpio1 25 GPIO_ACTIVE_LOW>; + + port { + camera_out: endpoint { + remote-endpoint = <&csi1_ep1>; + data-lanes = <1 2>; + }; + }; + }; + }; + +... -- 2.30.2 ^ permalink raw reply related [flat|nested] 14+ messages in thread
* Re: [PATCH v3 2/5] dt-bindings: media: document SK Hynix Hi-846 MIPI CSI-2 8M pixel sensor 2021-05-31 12:07 ` [PATCH v3 2/5] dt-bindings: media: document SK Hynix Hi-846 MIPI CSI-2 8M pixel sensor Martin Kepplinger @ 2021-05-31 23:13 ` Laurent Pinchart 2021-05-31 23:24 ` Laurent Pinchart 0 siblings, 1 reply; 14+ messages in thread From: Laurent Pinchart @ 2021-05-31 23:13 UTC (permalink / raw) To: Martin Kepplinger Cc: pavel, krzysztof.kozlowski, mchehab, paul.kocialkowski, robh, shawnx.tu, devicetree, kernel, linux-kernel, linux-media, phone-devel Hi Martin, Thank you for the patch. On Mon, May 31, 2021 at 02:07:34PM +0200, Martin Kepplinger wrote: > Document the bindings used for the SK Hynix Hi-846 CMOS camera driver. > > Signed-off-by: Martin Kepplinger <martin.kepplinger@puri.sm> > --- > .../bindings/media/i2c/hynix,hi846.yaml | 99 +++++++++++++++++++ > 1 file changed, 99 insertions(+) > create mode 100644 Documentation/devicetree/bindings/media/i2c/hynix,hi846.yaml > > diff --git a/Documentation/devicetree/bindings/media/i2c/hynix,hi846.yaml b/Documentation/devicetree/bindings/media/i2c/hynix,hi846.yaml > new file mode 100644 > index 000000000000..26462f6b5e69 > --- /dev/null > +++ b/Documentation/devicetree/bindings/media/i2c/hynix,hi846.yaml > @@ -0,0 +1,99 @@ > +# SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause) > +%YAML 1.2 > +--- > +$id: http://devicetree.org/schemas/media/i2c/hynix,hi846.yaml# > +$schema: http://devicetree.org/meta-schemas/core.yaml# > + > +title: SK Hynix Hi-846 1/4" 8M Pixel MIPI CSI-2 sensor > + > +maintainers: > + - Martin Kepplinger <martin.kepplinger@puri.sm> > + > +description: |- > + The Hi-846 is a raw image sensor with an MIPI CSI-2 image data > + interface and CCI (I2C compatible) control bus. The output format > + is 10bit Bayer. > + > +properties: > + compatible: > + const: hynix,hi846 > + > + reg: > + maxItems: 1 > + > + clocks: > + items: > + - description: Reference to the mclk clock. > + > + clock-names: > + items: > + - const: mclk > + > + reset-gpios: > + description: Reference to the GPIO connected to the reset pin. Active low. > + maxItems: 1 > + > + vdd-supply: > + description: Definition of the regulator used as 1.8V digital power supply. > + > + port: > + $ref: /schemas/graph.yaml#/properties/port > + additionalProperties: false You can drop the additionalProperties, the graph schema has unevaluatedProperties set to false already. > + > + properties: > + endpoint: > + $ref: /schemas/media/video-interfaces.yaml# > + unevaluatedProperties: false > + > + properties: > + data-lanes: > + oneOf: > + - items: > + - const: 1 > + - const: 2 > + - const: 3 > + - const: 4 > + - items: > + - const: 1 > + - const: 2 > + > + required: > + - data-lanes > + > +required: > + - compatible > + - reg > + - clocks > + - clock-names > + - reset-gpios I'd keep the reset-gpios property optional, in case the signal is hardwired. I don't have access to the sensor datasheet, so I can't provide comments on what may be missing. With the above two issues addressed, Reviewed-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com> > + - vdd-supply > + - port > + > +additionalProperties: false > + > +examples: > + - | > + #include <dt-bindings/gpio/gpio.h> > + > + i2c { > + #address-cells = <1>; > + #size-cells = <0>; > + > + hi846: camera@20 { > + compatible = "hynix,hi846"; > + reg = <0x20>; > + clocks = <&clk>; > + clock-names = "mclk"; > + vdd-supply = <®_camera_pwr_en>; /* 1.8v */ > + reset-gpios = <&gpio1 25 GPIO_ACTIVE_LOW>; > + > + port { > + camera_out: endpoint { > + remote-endpoint = <&csi1_ep1>; > + data-lanes = <1 2>; > + }; > + }; > + }; > + }; > + > +... -- Regards, Laurent Pinchart ^ permalink raw reply [flat|nested] 14+ messages in thread
* Re: [PATCH v3 2/5] dt-bindings: media: document SK Hynix Hi-846 MIPI CSI-2 8M pixel sensor 2021-05-31 23:13 ` Laurent Pinchart @ 2021-05-31 23:24 ` Laurent Pinchart 0 siblings, 0 replies; 14+ messages in thread From: Laurent Pinchart @ 2021-05-31 23:24 UTC (permalink / raw) To: Martin Kepplinger Cc: pavel, krzysztof.kozlowski, mchehab, paul.kocialkowski, robh, shawnx.tu, devicetree, kernel, linux-kernel, linux-media, phone-devel Hi Martin, I have now found the datasheet, thanks to the link provided in a later patch in this series :-) Please see below for a few additional comments. On Tue, Jun 01, 2021 at 02:13:43AM +0300, Laurent Pinchart wrote: > On Mon, May 31, 2021 at 02:07:34PM +0200, Martin Kepplinger wrote: > > Document the bindings used for the SK Hynix Hi-846 CMOS camera driver. > > > > Signed-off-by: Martin Kepplinger <martin.kepplinger@puri.sm> > > --- > > .../bindings/media/i2c/hynix,hi846.yaml | 99 +++++++++++++++++++ > > 1 file changed, 99 insertions(+) > > create mode 100644 Documentation/devicetree/bindings/media/i2c/hynix,hi846.yaml > > > > diff --git a/Documentation/devicetree/bindings/media/i2c/hynix,hi846.yaml b/Documentation/devicetree/bindings/media/i2c/hynix,hi846.yaml > > new file mode 100644 > > index 000000000000..26462f6b5e69 > > --- /dev/null > > +++ b/Documentation/devicetree/bindings/media/i2c/hynix,hi846.yaml > > @@ -0,0 +1,99 @@ > > +# SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause) > > +%YAML 1.2 > > +--- > > +$id: http://devicetree.org/schemas/media/i2c/hynix,hi846.yaml# > > +$schema: http://devicetree.org/meta-schemas/core.yaml# > > + > > +title: SK Hynix Hi-846 1/4" 8M Pixel MIPI CSI-2 sensor > > + > > +maintainers: > > + - Martin Kepplinger <martin.kepplinger@puri.sm> > > + > > +description: |- > > + The Hi-846 is a raw image sensor with an MIPI CSI-2 image data > > + interface and CCI (I2C compatible) control bus. The output format > > + is 10bit Bayer. > > + > > +properties: > > + compatible: > > + const: hynix,hi846 > > + > > + reg: > > + maxItems: 1 > > + > > + clocks: > > + items: > > + - description: Reference to the mclk clock. > > + > > + clock-names: > > + items: > > + - const: mclk > > + > > + reset-gpios: > > + description: Reference to the GPIO connected to the reset pin. Active low. I'd write "RESETB pin" to match the datasheet. Could you add a property for the XSHUTDOWN GPIO too ? You can name it shutdown-gpios. > > + maxItems: 1 > > + > > + vdd-supply: > > + description: Definition of the regulator used as 1.8V digital power supply. There's no VDD signal, and the only 1.8V supply is VDDIO, which can also use 2.8V. This is thus ambiguous. How are the different sensor power rails supplied on your board ? > > + > > + port: > > + $ref: /schemas/graph.yaml#/properties/port > > + additionalProperties: false > > You can drop the additionalProperties, the graph schema has > unevaluatedProperties set to false already. > > > + > > + properties: > > + endpoint: > > + $ref: /schemas/media/video-interfaces.yaml# > > + unevaluatedProperties: false > > + > > + properties: > > + data-lanes: > > + oneOf: > > + - items: > > + - const: 1 > > + - const: 2 > > + - const: 3 > > + - const: 4 > > + - items: > > + - const: 1 > > + - const: 2 > > + > > + required: > > + - data-lanes > > + > > +required: > > + - compatible > > + - reg > > + - clocks > > + - clock-names > > + - reset-gpios > > I'd keep the reset-gpios property optional, in case the signal is > hardwired. > > I don't have access to the sensor datasheet, so I can't provide comments > on what may be missing. With the above two issues addressed, > > Reviewed-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com> > > > + - vdd-supply > > + - port > > + > > +additionalProperties: false > > + > > +examples: > > + - | > > + #include <dt-bindings/gpio/gpio.h> > > + > > + i2c { > > + #address-cells = <1>; > > + #size-cells = <0>; > > + > > + hi846: camera@20 { > > + compatible = "hynix,hi846"; > > + reg = <0x20>; > > + clocks = <&clk>; > > + clock-names = "mclk"; > > + vdd-supply = <®_camera_pwr_en>; /* 1.8v */ > > + reset-gpios = <&gpio1 25 GPIO_ACTIVE_LOW>; > > + > > + port { > > + camera_out: endpoint { > > + remote-endpoint = <&csi1_ep1>; > > + data-lanes = <1 2>; > > + }; > > + }; > > + }; > > + }; > > + > > +... -- Regards, Laurent Pinchart ^ permalink raw reply [flat|nested] 14+ messages in thread
* [PATCH v3 3/5] media: i2c: add driver for the SK Hynix Hi-846 8M pixel camera 2021-05-31 12:07 [PATCH v3 0/5] Add support for the Hynix Hi-846 camera Martin Kepplinger 2021-05-31 12:07 ` [PATCH v3 1/5] dt-bindings: vendor-prefixes: Add SK Hynix Inc Martin Kepplinger 2021-05-31 12:07 ` [PATCH v3 2/5] dt-bindings: media: document SK Hynix Hi-846 MIPI CSI-2 8M pixel sensor Martin Kepplinger @ 2021-05-31 12:07 ` Martin Kepplinger 2021-06-01 0:14 ` Laurent Pinchart 2021-06-01 6:50 ` kernel test robot 2021-05-31 12:07 ` [PATCH v3 4/5] arm64: defconfig: enable VIDEO_HI846 Martin Kepplinger 2021-05-31 12:07 ` [PATCH v3 5/5] Documentation: i2c-cardlist: add the Hynix hi846 sensor Martin Kepplinger 4 siblings, 2 replies; 14+ messages in thread From: Martin Kepplinger @ 2021-05-31 12:07 UTC (permalink / raw) To: pavel, krzysztof.kozlowski, laurent.pinchart, mchehab, paul.kocialkowski, robh, shawnx.tu Cc: devicetree, kernel, linux-kernel, linux-media, martin.kepplinger, phone-devel The SK Hynix Hi-846 is a 1/4" 8M Pixel CMOS Image Sensor. It supports usual features like I2C control, CSI-2 for frame data, digital/analog gain control or test patterns. This driver supports the 640x480, 1280x720 and 1632x1224 resolution modes. It supports runtime PM in order not to draw any unnecessary power. The part is also called YACG4D0C9SHC and a datasheet can be found at https://product.skhynix.com/products/cis/cis.go The large sets of partly undocumented register values are for example found when searching for the hi846_mipi_raw_Sensor.c Android driver. Signed-off-by: Martin Kepplinger <martin.kepplinger@puri.sm> --- MAINTAINERS | 6 + drivers/media/i2c/Kconfig | 13 + drivers/media/i2c/Makefile | 1 + drivers/media/i2c/hi846.c | 2138 ++++++++++++++++++++++++++++++++++++ 4 files changed, 2158 insertions(+) create mode 100644 drivers/media/i2c/hi846.c diff --git a/MAINTAINERS b/MAINTAINERS index 503fd21901f1..27283b289123 100644 --- a/MAINTAINERS +++ b/MAINTAINERS @@ -8432,6 +8432,12 @@ S: Maintained T: git git://linuxtv.org/media_tree.git F: drivers/media/i2c/hi556.c +HYNIX HI846 SENSOR DRIVER +M: Martin Kepplinger <martin.kepplinger@puri.sm> +L: linux-media@vger.kernel.org +S: Maintained +F: drivers/media/i2c/hi846.c + Hyper-V/Azure CORE AND DRIVERS M: "K. Y. Srinivasan" <kys@microsoft.com> M: Haiyang Zhang <haiyangz@microsoft.com> diff --git a/drivers/media/i2c/Kconfig b/drivers/media/i2c/Kconfig index 462c0e059754..f8cf5bf8eb68 100644 --- a/drivers/media/i2c/Kconfig +++ b/drivers/media/i2c/Kconfig @@ -738,6 +738,19 @@ config VIDEO_HI556 To compile this driver as a module, choose M here: the module will be called hi556. +config VIDEO_HI846 + tristate "Hynix Hi-846 sensor support" + depends on I2C && VIDEO_V4L2 + select MEDIA_CONTROLLER + select VIDEO_V4L2_SUBDEV_API + select V4L2_FWNODE + help + This is a Video4Linux2 sensor driver for the Hynix + Hi-846 camera. + + To compile this driver as a module, choose M here: the + module will be called hi846. + config VIDEO_IMX214 tristate "Sony IMX214 sensor support" depends on GPIOLIB && I2C && VIDEO_V4L2 diff --git a/drivers/media/i2c/Makefile b/drivers/media/i2c/Makefile index 0c067beca066..1194c5e6708b 100644 --- a/drivers/media/i2c/Makefile +++ b/drivers/media/i2c/Makefile @@ -116,6 +116,7 @@ obj-$(CONFIG_VIDEO_ML86V7667) += ml86v7667.o obj-$(CONFIG_VIDEO_OV2659) += ov2659.o obj-$(CONFIG_VIDEO_TC358743) += tc358743.o obj-$(CONFIG_VIDEO_HI556) += hi556.o +obj-$(CONFIG_VIDEO_HI846) += hi846.o obj-$(CONFIG_VIDEO_IMX214) += imx214.o obj-$(CONFIG_VIDEO_IMX219) += imx219.o obj-$(CONFIG_VIDEO_IMX258) += imx258.o diff --git a/drivers/media/i2c/hi846.c b/drivers/media/i2c/hi846.c new file mode 100644 index 000000000000..80d1ccb15123 --- /dev/null +++ b/drivers/media/i2c/hi846.c @@ -0,0 +1,2138 @@ +// SPDX-License-Identifier: GPL-2.0 +// Copyright (c) 2021 Purism SPC + +#include <asm/unaligned.h> +#include <linux/clk.h> +#include <linux/delay.h> +#include <linux/gpio.h> +#include <linux/i2c.h> +#include <linux/module.h> +#include <linux/of_gpio.h> +#include <linux/of_graph.h> +#include <linux/regulator/consumer.h> +#include <linux/pm_runtime.h> +#include <linux/pm.h> +#include <media/v4l2-ctrls.h> +#include <media/v4l2-device.h> +#include <media/v4l2-fwnode.h> + + +#define HI846_MEDIA_BUS_FORMAT MEDIA_BUS_FMT_SGBRG10_1X10 +#define HI846_RGB_DEPTH 10 +#define DEFAULT_FPS 30 + +/* Frame length lines / Vertical timings */ +#define HI846_REG_FLL 0x0006 +#define HI846_FLL_MAX 0xffff + +/* Horizontal timing */ +#define HI846_REG_LLP 0x0008 +#define HI846_LINE_LENGTH 3800 + +#define HI846_REG_BINNING_MODE 0x000c + +#define HI846_REG_IMAGE_ORIENTATION 0x000e + +#define HI846_REG_UNKNOWN_0022 0x0022 + +#define HI846_REG_Y_ADDR_START_VACT_H 0x0026 +#define HI846_REG_Y_ADDR_START_VACT_L 0x0027 +#define HI846_REG_UNKNOWN_0028 0x0028 + +#define HI846_REG_Y_ADDR_END_VACT_H 0x002c +#define HI846_REG_Y_ADDR_END_VACT_L 0x002d + +#define HI846_REG_Y_ODD_INC_FOBP 0x002e +#define HI846_REG_Y_EVEN_INC_FOBP 0x002f + +#define HI846_REG_Y_ODD_INC_VACT 0x0032 +#define HI846_REG_Y_EVEN_INC_VACT 0x0033 + +#define HI846_REG_GROUPED_PARA_HOLD 0x0046 + +#define HI846_REG_TG_ENABLE 0x004c + +#define HI846_REG_UNKNOWN_005C 0x005c + +#define HI846_REG_UNKNOWN_006A 0x006a + +/* Long exposure time. Actually, exposure is a 20 bit value that + * includes the lower 4 bits of 0x0073 too. only 16 bit are used + * right now + */ +#define HI846_REG_EXPOSURE 0x0074 +#define HI846_EXPOSURE_MIN 6 +#define HI846_EXPOSURE_MAX_MARGIN 2 +#define HI846_EXPOSURE_STEP 1 + +/* Analog gain controls from sensor */ +#define HI846_REG_ANALOG_GAIN 0x0077 +#define HI846_ANAL_GAIN_MIN 0 +#define HI846_ANAL_GAIN_MAX 240 +#define HI846_ANAL_GAIN_STEP 8 + +/* Digital gain controls from sensor */ +#define HI846_REG_MWB_GR_GAIN_H 0x0078 +#define HI846_REG_MWB_GR_GAIN_L 0x0079 +#define HI846_REG_MWB_GB_GAIN_H 0x007a +#define HI846_REG_MWB_GB_GAIN_L 0x007b +#define HI846_REG_MWB_R_GAIN_H 0x007c +#define HI846_REG_MWB_R_GAIN_L 0x007d +#define HI846_REG_MWB_B_GAIN_H 0x007e +#define HI846_REG_MWB_B_GAIN_L 0x007f +#define HI846_DGTL_GAIN_MIN 0 +#define HI846_DGTL_GAIN_MAX 8191 +#define HI846_DGTL_GAIN_STEP 1 +#define HI846_DGTL_GAIN_DEFAULT 256 + +#define HI846_REG_X_ADDR_START_HACT_H 0x0120 +#define HI846_REG_X_ADDR_END_HACT_H 0x0122 + +#define HI846_REG_UNKNOWN_012A 0x012a + +#define HI846_REG_UNKNOWN_0200 0x0200 + +#define HI846_REG_UNKNOWN_021C 0x021c +#define HI846_REG_UNKNOWN_021E 0x021e + +#define HI846_REG_UNKNOWN_0402 0x0402 +#define HI846_REG_UNKNOWN_0404 0x0404 +#define HI846_REG_UNKNOWN_0408 0x0408 +#define HI846_REG_UNKNOWN_0410 0x0410 +#define HI846_REG_UNKNOWN_0412 0x0412 +#define HI846_REG_UNKNOWN_0414 0x0414 + +#define HI846_REG_UNKNOWN_0418 0x0418 + +#define HI846_REG_UNKNOWN_051E 0x051e + +/* Formatter */ +#define HI846_REG_X_START_H 0x0804 +#define HI846_REG_X_START_L 0x0805 + +/* MIPI */ +#define HI846_REG_UNKNOWN_0900 0x0900 +#define HI846_REG_MIPI_TX_OP_EN 0x0901 +#define HI846_REG_MIPI_TX_OP_MODE 0x0902 +#define HI846_RAW8 BIT(5) + +#define HI846_REG_UNKNOWN_090C 0x090c +#define HI846_REG_UNKNOWN_090E 0x090e + +#define HI846_REG_UNKNOWN_0914 0x0914 +#define HI846_REG_TLPX 0x0915 +#define HI846_REG_TCLK_PREPARE 0x0916 +#define HI846_REG_TCLK_ZERO 0x0917 +#define HI846_REG_UNKNOWN_0918 0x0918 +#define HI846_REG_THS_PREPARE 0x0919 +#define HI846_REG_THS_ZERO 0x091a +#define HI846_REG_THS_TRAIL 0x091b +#define HI846_REG_TCLK_POST 0x091c +#define HI846_REG_TCLK_TRAIL_MIN 0x091d +#define HI846_REG_UNKNOWN_091E 0x091e + +#define HI846_REG_UNKNOWN_0954 0x0954 +#define HI846_REG_UNKNOWN_0956 0x0956 +#define HI846_REG_UNKNOWN_0958 0x0958 +#define HI846_REG_UNKNOWN_095A 0x095a + +/* ISP Common */ +#define HI846_REG_MODE_SELECT 0x0a00 +#define HI846_MODE_STANDBY 0x00 +#define HI846_MODE_STREAMING 0x01 +#define HI846_REG_FAST_STANDBY_MODE 0x0a02 +#define HI846_REG_ISP_EN_H 0x0a04 + +/* Test Pattern Control */ +#define HI846_REG_ISP 0x0a05 +#define HI846_REG_ISP_TPG_EN 0x01 +#define HI846_REG_TEST_PATTERN 0x020a /* 1-9 */ + +#define HI846_REG_UNKNOWN_0A0C 0x0a0c + +/* Windowing */ +#define HI846_REG_X_OUTPUT_SIZE_H 0x0a12 +#define HI846_REG_X_OUTPUT_SIZE_L 0x0a13 +#define HI846_REG_Y_OUTPUT_SIZE_H 0x0a14 +#define HI846_REG_Y_OUTPUT_SIZE_L 0x0a15 + +/* ISP Common */ +#define HI846_REG_PEDESTAL_EN 0x0a1a + +#define HI846_REG_UNKNOWN_0A1E 0x0a1e + +/* Horizontal Binning Mode */ +#define HI846_REG_HBIN_MODE 0x0a22 + +#define HI846_REG_UNKNOWN_0A24 0x0a24 +#define HI846_REG_UNKNOWN_0B02 0x0b02 +#define HI846_REG_UNKNOWN_0B10 0x0b10 +#define HI846_REG_UNKNOWN_0B12 0x0b12 +#define HI846_REG_UNKNOWN_0B14 0x0b14 + +/* BLC (Black Level Calibration) */ +#define HI846_REG_BLC_CTL0 0x0c00 + +#define HI846_REG_UNKNOWN_0C06 0x0c06 +#define HI846_REG_UNKNOWN_0C10 0x0c10 +#define HI846_REG_UNKNOWN_0C12 0x0c12 +#define HI846_REG_UNKNOWN_0C14 0x0c14 +#define HI846_REG_UNKNOWN_0C16 0x0c16 + +#define HI846_REG_UNKNOWN_0E04 0x0e04 + +#define HI846_REG_CHIP_ID_L 0x0f16 +#define HI846_REG_CHIP_ID_H 0x0f17 +#define HI846_CHIP_ID_L 0x46 +#define HI846_CHIP_ID_H 0x08 + +#define HI846_REG_UNKNOWN_0F04 0x0f04 +#define HI846_REG_UNKNOWN_0F08 0x0f08 + +/* PLL */ +#define HI846_REG_PLL_CFG_MIPI2_H 0x0f2a +#define HI846_REG_PLL_CFG_MIPI2_L 0x0f2b + +#define HI846_REG_UNKNOWN_0F30 0x0f30 +#define HI846_REG_PLL_CFG_RAMP1_H 0x0f32 +#define HI846_REG_UNKNOWN_0F36 0x0f36 +#define HI846_REG_PLL_CFG_MIPI1_H 0x0f38 + +#define HI846_REG_UNKNOWN_2008 0x2008 +#define HI846_REG_UNKNOWN_326E 0x326e + +struct hi846_reg { + u16 address; + u16 val; +}; + +struct hi846_reg_list { + u32 num_of_regs; + const struct hi846_reg *regs; +}; + +struct hi846_mode { + /* Frame width in pixels */ + u32 width; + + /* Frame height in pixels */ + u32 height; + + /* Horizontal timing size */ + u32 llp; + + /* Link frequency needed for this resolution */ + u8 link_freq_index; + + u16 fps; + + /* vertical timining size */ + u16 frame_len; + + const struct hi846_reg_list reg_list_config; + const struct hi846_reg_list reg_list_2lane; + const struct hi846_reg_list reg_list_4lane; +}; + +#define to_hi846(_sd) container_of(_sd, struct hi846, sd) + +static const struct hi846_reg hi846_init_2lane[] = { + {HI846_REG_MODE_SELECT, 0x0000}, + /* regs below are unknown */ + {0x2000, 0x100A}, + {0x2002, 0x00FF}, + {0x2004, 0x0007}, + {0x2006, 0x3FFF}, + {0x2008, 0x3FFF}, + {0x200A, 0xC216}, + {0x200C, 0x1292}, + {0x200E, 0xC01A}, + {0x2010, 0x403D}, + {0x2012, 0x000E}, + {0x2014, 0x403E}, + {0x2016, 0x0B80}, + {0x2018, 0x403F}, + {0x201A, 0x82AE}, + {0x201C, 0x1292}, + {0x201E, 0xC00C}, + {0x2020, 0x4130}, + {0x2022, 0x43E2}, + {0x2024, 0x0180}, + {0x2026, 0x4130}, + {0x2028, 0x7400}, + {0x202A, 0x5000}, + {0x202C, 0x0253}, + {0x202E, 0x0AD1}, + {0x2030, 0x2360}, + {0x2032, 0x0009}, + {0x2034, 0x5020}, + {0x2036, 0x000B}, + {0x2038, 0x0002}, + {0x203A, 0x0044}, + {0x203C, 0x0016}, + {0x203E, 0x1792}, + {0x2040, 0x7002}, + {0x2042, 0x154F}, + {0x2044, 0x00D5}, + {0x2046, 0x000B}, + {0x2048, 0x0019}, + {0x204A, 0x1698}, + {0x204C, 0x000E}, + {0x204E, 0x099A}, + {0x2050, 0x0058}, + {0x2052, 0x7000}, + {0x2054, 0x1799}, + {0x2056, 0x0310}, + {0x2058, 0x03C3}, + {0x205A, 0x004C}, + {0x205C, 0x064A}, + {0x205E, 0x0001}, + {0x2060, 0x0007}, + {0x2062, 0x0BC7}, + {0x2064, 0x0055}, + {0x2066, 0x7000}, + {0x2068, 0x1550}, + {0x206A, 0x158A}, + {0x206C, 0x0004}, + {0x206E, 0x1488}, + {0x2070, 0x7010}, + {0x2072, 0x1508}, + {0x2074, 0x0004}, + {0x2076, 0x0016}, + {0x2078, 0x03D5}, + {0x207A, 0x0055}, + {0x207C, 0x08CA}, + {0x207E, 0x2019}, + {0x2080, 0x0007}, + {0x2082, 0x7057}, + {0x2084, 0x0FC7}, + {0x2086, 0x5041}, + {0x2088, 0x12C8}, + {0x208A, 0x5060}, + {0x208C, 0x5080}, + {0x208E, 0x2084}, + {0x2090, 0x12C8}, + {0x2092, 0x7800}, + {0x2094, 0x0802}, + {0x2096, 0x040F}, + {0x2098, 0x1007}, + {0x209A, 0x0803}, + {0x209C, 0x080B}, + {0x209E, 0x3803}, + {0x20A0, 0x0807}, + {0x20A2, 0x0404}, + {0x20A4, 0x0400}, + {0x20A6, 0xFFFF}, + {0x20A8, 0xF0B2}, + {0x20AA, 0xFFEF}, + {0x20AC, 0x0A84}, + {0x20AE, 0x1292}, + {0x20B0, 0xC02E}, + {0x20B2, 0x4130}, + {0x23FE, 0xC056}, + {0x3232, 0xFC0C}, + {0x3236, 0xFC22}, + {0x3248, 0xFCA8}, + {0x326A, 0x8302}, + {0x326C, 0x830A}, + {0x326E, 0x0000}, + {0x32CA, 0xFC28}, + {0x32CC, 0xC3BC}, + {0x32CE, 0xC34C}, + {0x32D0, 0xC35A}, + {0x32D2, 0xC368}, + {0x32D4, 0xC376}, + {0x32D6, 0xC3C2}, + {0x32D8, 0xC3E6}, + {0x32DA, 0x0003}, + {0x32DC, 0x0003}, + {0x32DE, 0x00C7}, + {0x32E0, 0x0031}, + {0x32E2, 0x0031}, + {0x32E4, 0x0031}, + {0x32E6, 0xFC28}, + {0x32E8, 0xC3BC}, + {0x32EA, 0xC384}, + {0x32EC, 0xC392}, + {0x32EE, 0xC3A0}, + {0x32F0, 0xC3AE}, + {0x32F2, 0xC3C4}, + {0x32F4, 0xC3E6}, + {0x32F6, 0x0003}, + {0x32F8, 0x0003}, + {0x32FA, 0x00C7}, + {0x32FC, 0x0031}, + {0x32FE, 0x0031}, + {0x3300, 0x0031}, + {0x3302, 0x82CA}, + {0x3304, 0xC164}, + {0x3306, 0x82E6}, + {0x3308, 0xC19C}, + {0x330A, 0x001F}, + {0x330C, 0x001A}, + {0x330E, 0x0034}, + {0x3310, 0x0000}, + {0x3312, 0x0000}, + {0x3314, 0xFC94}, + {0x3316, 0xC3D8}, + /* regs above are unknown */ + {HI846_REG_MODE_SELECT, 0x0000}, + {HI846_REG_UNKNOWN_0E04, 0x0012}, + {HI846_REG_Y_ODD_INC_FOBP, 0x1111}, + {HI846_REG_Y_ODD_INC_VACT, 0x1111}, + {HI846_REG_UNKNOWN_0022, 0x0008}, + {HI846_REG_Y_ADDR_START_VACT_H, 0x0040}, + {HI846_REG_UNKNOWN_0028, 0x0017}, + {HI846_REG_Y_ADDR_END_VACT_H, 0x09CF}, + {HI846_REG_UNKNOWN_005C, 0x2101}, + {HI846_REG_FLL, 0x09DE}, + {HI846_REG_LLP, 0x0ED8}, + {HI846_REG_IMAGE_ORIENTATION, 0x0100}, + {HI846_REG_BINNING_MODE, 0x0022}, + {HI846_REG_HBIN_MODE, 0x0000}, + {HI846_REG_UNKNOWN_0A24, 0x0000}, + {HI846_REG_X_START_H, 0x0000}, + {HI846_REG_X_OUTPUT_SIZE_H, 0x0CC0}, + {HI846_REG_Y_OUTPUT_SIZE_H, 0x0990}, + {HI846_REG_EXPOSURE, 0x09D8}, + {HI846_REG_ANALOG_GAIN, 0x0000}, + {HI846_REG_GROUPED_PARA_HOLD, 0x0000}, + {HI846_REG_UNKNOWN_051E, 0x0000}, + {HI846_REG_UNKNOWN_0200, 0x0400}, + {HI846_REG_PEDESTAL_EN, 0x0C00}, + {HI846_REG_UNKNOWN_0A0C, 0x0010}, + {HI846_REG_UNKNOWN_0A1E, 0x0CCF}, + {HI846_REG_UNKNOWN_0402, 0x0110}, + {HI846_REG_UNKNOWN_0404, 0x00F4}, + {HI846_REG_UNKNOWN_0408, 0x0000}, + {HI846_REG_UNKNOWN_0410, 0x008D}, + {HI846_REG_UNKNOWN_0412, 0x011A}, + {HI846_REG_UNKNOWN_0414, 0x864C}, + {HI846_REG_UNKNOWN_021C, 0x0003}, + {HI846_REG_UNKNOWN_021E, 0x0235}, + {HI846_REG_BLC_CTL0, 0x9150}, + {HI846_REG_UNKNOWN_0C06, 0x0021}, + {HI846_REG_UNKNOWN_0C10, 0x0040}, + {HI846_REG_UNKNOWN_0C12, 0x0040}, + {HI846_REG_UNKNOWN_0C14, 0x0040}, + {HI846_REG_UNKNOWN_0C16, 0x0040}, + {HI846_REG_FAST_STANDBY_MODE, 0x0100}, + {HI846_REG_ISP_EN_H, 0x014A}, + {HI846_REG_UNKNOWN_0418, 0x0000}, + {HI846_REG_UNKNOWN_012A, 0x03B4}, + {HI846_REG_X_ADDR_START_HACT_H, 0x0046}, + {HI846_REG_X_ADDR_END_HACT_H, 0x0376}, + {HI846_REG_UNKNOWN_0B02, 0xE04D}, + {HI846_REG_UNKNOWN_0B10, 0x6821}, + {HI846_REG_UNKNOWN_0B12, 0x0120}, + {HI846_REG_UNKNOWN_0B14, 0x0001}, + {HI846_REG_UNKNOWN_2008, 0x38FD}, + {HI846_REG_UNKNOWN_326E, 0x0000}, + {HI846_REG_UNKNOWN_0900, 0x0320}, + {HI846_REG_MIPI_TX_OP_MODE, 0xC31A}, + {HI846_REG_UNKNOWN_0914, 0xC109}, + {HI846_REG_TCLK_PREPARE, 0x061A}, + {HI846_REG_UNKNOWN_0918, 0x0306}, + {HI846_REG_THS_ZERO, 0x0B09}, + {HI846_REG_TCLK_POST, 0x0C07}, + {HI846_REG_UNKNOWN_091E, 0x0A00}, + {HI846_REG_UNKNOWN_090C, 0x042A}, + {HI846_REG_UNKNOWN_090E, 0x006B}, + {HI846_REG_UNKNOWN_0954, 0x0089}, + {HI846_REG_UNKNOWN_0956, 0x0000}, + {HI846_REG_UNKNOWN_0958, 0xCA00}, + {HI846_REG_UNKNOWN_095A, 0x9240}, + {HI846_REG_UNKNOWN_0F08, 0x2F04}, + {HI846_REG_UNKNOWN_0F30, 0x001F}, + {HI846_REG_UNKNOWN_0F36, 0x001F}, + {HI846_REG_UNKNOWN_0F04, 0x3A00}, + {HI846_REG_PLL_CFG_RAMP1_H, 0x025A}, + {HI846_REG_PLL_CFG_MIPI1_H, 0x025A}, + {HI846_REG_PLL_CFG_MIPI2_H, 0x0024}, + {HI846_REG_UNKNOWN_006A, 0x0100}, + {HI846_REG_TG_ENABLE, 0x0100}, +}; + +static const struct hi846_reg hi846_init_4lane[] = { + {0x2000, 0x987A}, + {0x2002, 0x00FF}, + {0x2004, 0x0047}, + {0x2006, 0x3FFF}, + {0x2008, 0x3FFF}, + {0x200A, 0xC216}, + {0x200C, 0x1292}, + {0x200E, 0xC01A}, + {0x2010, 0x403D}, + {0x2012, 0x000E}, + {0x2014, 0x403E}, + {0x2016, 0x0B80}, + {0x2018, 0x403F}, + {0x201A, 0x82AE}, + {0x201C, 0x1292}, + {0x201E, 0xC00C}, + {0x2020, 0x4130}, + {0x2022, 0x43E2}, + {0x2024, 0x0180}, + {0x2026, 0x4130}, + {0x2028, 0x7400}, + {0x202A, 0x5000}, + {0x202C, 0x0253}, + {0x202E, 0x0AD1}, + {0x2030, 0x2360}, + {0x2032, 0x0009}, + {0x2034, 0x5020}, + {0x2036, 0x000B}, + {0x2038, 0x0002}, + {0x203A, 0x0044}, + {0x203C, 0x0016}, + {0x203E, 0x1792}, + {0x2040, 0x7002}, + {0x2042, 0x154F}, + {0x2044, 0x00D5}, + {0x2046, 0x000B}, + {0x2048, 0x0019}, + {0x204A, 0x1698}, + {0x204C, 0x000E}, + {0x204E, 0x099A}, + {0x2050, 0x0058}, + {0x2052, 0x7000}, + {0x2054, 0x1799}, + {0x2056, 0x0310}, + {0x2058, 0x03C3}, + {0x205A, 0x004C}, + {0x205C, 0x064A}, + {0x205E, 0x0001}, + {0x2060, 0x0007}, + {0x2062, 0x0BC7}, + {0x2064, 0x0055}, + {0x2066, 0x7000}, + {0x2068, 0x1550}, + {0x206A, 0x158A}, + {0x206C, 0x0004}, + {0x206E, 0x1488}, + {0x2070, 0x7010}, + {0x2072, 0x1508}, + {0x2074, 0x0004}, + {0x2076, 0x0016}, + {0x2078, 0x03D5}, + {0x207A, 0x0055}, + {0x207C, 0x08CA}, + {0x207E, 0x2019}, + {0x2080, 0x0007}, + {0x2082, 0x7057}, + {0x2084, 0x0FC7}, + {0x2086, 0x5041}, + {0x2088, 0x12C8}, + {0x208A, 0x5060}, + {0x208C, 0x5080}, + {0x208E, 0x2084}, + {0x2090, 0x12C8}, + {0x2092, 0x7800}, + {0x2094, 0x0802}, + {0x2096, 0x040F}, + {0x2098, 0x1007}, + {0x209A, 0x0803}, + {0x209C, 0x080B}, + {0x209E, 0x3803}, + {0x20A0, 0x0807}, + {0x20A2, 0x0404}, + {0x20A4, 0x0400}, + {0x20A6, 0xFFFF}, + {0x20A8, 0xF0B2}, + {0x20AA, 0xFFEF}, + {0x20AC, 0x0A84}, + {0x20AE, 0x1292}, + {0x20B0, 0xC02E}, + {0x20B2, 0x4130}, + {0x20B4, 0xF0B2}, + {0x20B6, 0xFFBF}, + {0x20B8, 0x2004}, + {0x20BA, 0x403F}, + {0x20BC, 0x00C3}, + {0x20BE, 0x4FE2}, + {0x20C0, 0x8318}, + {0x20C2, 0x43CF}, + {0x20C4, 0x0000}, + {0x20C6, 0x9382}, + {0x20C8, 0xC314}, + {0x20CA, 0x2003}, + {0x20CC, 0x12B0}, + {0x20CE, 0xCAB0}, + {0x20D0, 0x4130}, + {0x20D2, 0x12B0}, + {0x20D4, 0xC90A}, + {0x20D6, 0x4130}, + {0x20D8, 0x42D2}, + {0x20DA, 0x8318}, + {0x20DC, 0x00C3}, + {0x20DE, 0x9382}, + {0x20E0, 0xC314}, + {0x20E2, 0x2009}, + {0x20E4, 0x120B}, + {0x20E6, 0x120A}, + {0x20E8, 0x1209}, + {0x20EA, 0x1208}, + {0x20EC, 0x1207}, + {0x20EE, 0x1206}, + {0x20F0, 0x4030}, + {0x20F2, 0xC15E}, + {0x20F4, 0x4130}, + {0x20F6, 0x1292}, + {0x20F8, 0xC008}, + {0x20FA, 0x4130}, + {0x20FC, 0x42D2}, + {0x20FE, 0x82A1}, + {0x2100, 0x00C2}, + {0x2102, 0x1292}, + {0x2104, 0xC040}, + {0x2106, 0x4130}, + {0x2108, 0x1292}, + {0x210A, 0xC006}, + {0x210C, 0x42A2}, + {0x210E, 0x7324}, + {0x2110, 0x9382}, + {0x2112, 0xC314}, + {0x2114, 0x2011}, + {0x2116, 0x425F}, + {0x2118, 0x82A1}, + {0x211A, 0xF25F}, + {0x211C, 0x00C1}, + {0x211E, 0xF35F}, + {0x2120, 0x2406}, + {0x2122, 0x425F}, + {0x2124, 0x00C0}, + {0x2126, 0xF37F}, + {0x2128, 0x522F}, + {0x212A, 0x4F82}, + {0x212C, 0x7324}, + {0x212E, 0x425F}, + {0x2130, 0x82D4}, + {0x2132, 0xF35F}, + {0x2134, 0x4FC2}, + {0x2136, 0x01B3}, + {0x2138, 0x93C2}, + {0x213A, 0x829F}, + {0x213C, 0x2421}, + {0x213E, 0x403E}, + {0x2140, 0xFFFE}, + {0x2142, 0x40B2}, + {0x2144, 0xEC78}, + {0x2146, 0x831C}, + {0x2148, 0x40B2}, + {0x214A, 0xEC78}, + {0x214C, 0x831E}, + {0x214E, 0x40B2}, + {0x2150, 0xEC78}, + {0x2152, 0x8320}, + {0x2154, 0xB3D2}, + {0x2156, 0x008C}, + {0x2158, 0x2405}, + {0x215A, 0x4E0F}, + {0x215C, 0x503F}, + {0x215E, 0xFFD8}, + {0x2160, 0x4F82}, + {0x2162, 0x831C}, + {0x2164, 0x90F2}, + {0x2166, 0x0003}, + {0x2168, 0x008C}, + {0x216A, 0x2401}, + {0x216C, 0x4130}, + {0x216E, 0x421F}, + {0x2170, 0x831C}, + {0x2172, 0x5E0F}, + {0x2174, 0x4F82}, + {0x2176, 0x831E}, + {0x2178, 0x5E0F}, + {0x217A, 0x4F82}, + {0x217C, 0x8320}, + {0x217E, 0x3FF6}, + {0x2180, 0x432E}, + {0x2182, 0x3FDF}, + {0x2184, 0x421F}, + {0x2186, 0x7100}, + {0x2188, 0x4F0E}, + {0x218A, 0x503E}, + {0x218C, 0xFFD8}, + {0x218E, 0x4E82}, + {0x2190, 0x7A04}, + {0x2192, 0x421E}, + {0x2194, 0x831C}, + {0x2196, 0x5F0E}, + {0x2198, 0x4E82}, + {0x219A, 0x7A06}, + {0x219C, 0x0B00}, + {0x219E, 0x7304}, + {0x21A0, 0x0050}, + {0x21A2, 0x40B2}, + {0x21A4, 0xD081}, + {0x21A6, 0x0B88}, + {0x21A8, 0x421E}, + {0x21AA, 0x831E}, + {0x21AC, 0x5F0E}, + {0x21AE, 0x4E82}, + {0x21B0, 0x7A0E}, + {0x21B2, 0x521F}, + {0x21B4, 0x8320}, + {0x21B6, 0x4F82}, + {0x21B8, 0x7A10}, + {0x21BA, 0x0B00}, + {0x21BC, 0x7304}, + {0x21BE, 0x007A}, + {0x21C0, 0x40B2}, + {0x21C2, 0x0081}, + {0x21C4, 0x0B88}, + {0x21C6, 0x4392}, + {0x21C8, 0x7A0A}, + {0x21CA, 0x0800}, + {0x21CC, 0x7A0C}, + {0x21CE, 0x0B00}, + {0x21D0, 0x7304}, + {0x21D2, 0x022B}, + {0x21D4, 0x40B2}, + {0x21D6, 0xD081}, + {0x21D8, 0x0B88}, + {0x21DA, 0x0B00}, + {0x21DC, 0x7304}, + {0x21DE, 0x0255}, + {0x21E0, 0x40B2}, + {0x21E2, 0x0081}, + {0x21E4, 0x0B88}, + {0x21E6, 0x4130}, + {0x23FE, 0xC056}, + {0x3232, 0xFC0C}, + {0x3236, 0xFC22}, + {0x3238, 0xFCFC}, + {0x323A, 0xFD84}, + {0x323C, 0xFD08}, + {0x3246, 0xFCD8}, + {0x3248, 0xFCA8}, + {0x324E, 0xFCB4}, + {0x326A, 0x8302}, + {0x326C, 0x830A}, + {0x326E, 0x0000}, + {0x32CA, 0xFC28}, + {0x32CC, 0xC3BC}, + {0x32CE, 0xC34C}, + {0x32D0, 0xC35A}, + {0x32D2, 0xC368}, + {0x32D4, 0xC376}, + {0x32D6, 0xC3C2}, + {0x32D8, 0xC3E6}, + {0x32DA, 0x0003}, + {0x32DC, 0x0003}, + {0x32DE, 0x00C7}, + {0x32E0, 0x0031}, + {0x32E2, 0x0031}, + {0x32E4, 0x0031}, + {0x32E6, 0xFC28}, + {0x32E8, 0xC3BC}, + {0x32EA, 0xC384}, + {0x32EC, 0xC392}, + {0x32EE, 0xC3A0}, + {0x32F0, 0xC3AE}, + {0x32F2, 0xC3C4}, + {0x32F4, 0xC3E6}, + {0x32F6, 0x0003}, + {0x32F8, 0x0003}, + {0x32FA, 0x00C7}, + {0x32FC, 0x0031}, + {0x32FE, 0x0031}, + {0x3300, 0x0031}, + {0x3302, 0x82CA}, + {0x3304, 0xC164}, + {0x3306, 0x82E6}, + {0x3308, 0xC19C}, + {0x330A, 0x001F}, + {0x330C, 0x001A}, + {0x330E, 0x0034}, + {0x3310, 0x0000}, + {0x3312, 0x0000}, + {0x3314, 0xFC94}, + {0x3316, 0xC3D8}, + + {0x0A00, 0x0000}, + {0x0E04, 0x0012}, + {0x002E, 0x1111}, + {0x0032, 0x1111}, + {0x0022, 0x0008}, + {0x0026, 0x0040}, + {0x0028, 0x0017}, + {0x002C, 0x09CF}, + {0x005C, 0x2101}, + {0x0006, 0x09DE}, + {0x0008, 0x0ED8}, + {0x000E, 0x0100}, + {0x000C, 0x0022}, + {0x0A22, 0x0000}, + {0x0A24, 0x0000}, + {0x0804, 0x0000}, + {0x0A12, 0x0CC0}, + {0x0A14, 0x0990}, + {0x0074, 0x09D8}, + {0x0076, 0x0000}, + {0x051E, 0x0000}, + {0x0200, 0x0400}, + {0x0A1A, 0x0C00}, + {0x0A0C, 0x0010}, + {0x0A1E, 0x0CCF}, + {0x0402, 0x0110}, + {0x0404, 0x00F4}, + {0x0408, 0x0000}, + {0x0410, 0x008D}, + {0x0412, 0x011A}, + {0x0414, 0x864C}, + /* For OTP */ + {0x021C, 0x0003}, + {0x021E, 0x0235}, + /* For OTP */ + {0x0C00, 0x9950}, + {0x0C06, 0x0021}, + {0x0C10, 0x0040}, + {0x0C12, 0x0040}, + {0x0C14, 0x0040}, + {0x0C16, 0x0040}, + {0x0A02, 0x0100}, + {0x0A04, 0x015A}, + {0x0418, 0x0000}, + {0x0128, 0x0028}, + {0x012A, 0xFFFF}, + {0x0120, 0x0046}, + {0x0122, 0x0376}, + {0x012C, 0x0020}, + {0x012E, 0xFFFF}, + {0x0124, 0x0040}, + {0x0126, 0x0378}, + {0x0746, 0x0050}, + {0x0748, 0x01D5}, + {0x074A, 0x022B}, + {0x074C, 0x03B0}, + {0x0756, 0x043F}, + {0x0758, 0x3F1D}, + {0x0B02, 0xE04D}, + {0x0B10, 0x6821}, + {0x0B12, 0x0120}, + {0x0B14, 0x0001}, + {0x2008, 0x38FD}, + {0x326E, 0x0000}, + {0x0900, 0x0300}, + {0x0902, 0xC319}, + {0x0914, 0xC109}, + {0x0916, 0x061A}, + {0x0918, 0x0407}, + {0x091A, 0x0A0B}, + {0x091C, 0x0E08}, + {0x091E, 0x0A00}, + {0x090C, 0x0427}, + {0x090E, 0x0059}, + {0x0954, 0x0089}, + {0x0956, 0x0000}, + {0x0958, 0xCA80}, + {0x095A, 0x9240}, + {0x0F08, 0x2F04}, + {0x0F30, 0x001F}, + {0x0F36, 0x001F}, + {0x0F04, 0x3A00}, + {0x0F32, 0x025A}, + {0x0F38, 0x025A}, + {0x0F2A, 0x4124}, + {0x006A, 0x0100}, + {0x004C, 0x0100}, + {0x0044, 0x0001}, +}; + +static const struct hi846_reg mode_640x480_config[] = { + {HI846_REG_MODE_SELECT, 0x0000}, + {HI846_REG_Y_ODD_INC_FOBP, 0x7711}, + {HI846_REG_Y_ODD_INC_VACT, 0x7711}, + {HI846_REG_Y_ADDR_START_VACT_H, 0x0148}, + {HI846_REG_Y_ADDR_END_VACT_H, 0x08C7}, + {HI846_REG_UNKNOWN_005C, 0x4404}, + {HI846_REG_FLL, 0x0277}, + {HI846_REG_LLP, 0x0ED8}, + {HI846_REG_BINNING_MODE, 0x0322}, + {HI846_REG_HBIN_MODE, 0x0200}, + {HI846_REG_UNKNOWN_0A24, 0x0000}, + {HI846_REG_X_START_H, 0x0058}, + {HI846_REG_X_OUTPUT_SIZE_H, 0x0280}, + {HI846_REG_Y_OUTPUT_SIZE_H, 0x01E0}, + + /* For OTP */ + {HI846_REG_UNKNOWN_021C, 0x0003}, + {HI846_REG_UNKNOWN_021E, 0x0235}, + + {HI846_REG_ISP_EN_H, 0x017A}, + {HI846_REG_UNKNOWN_0418, 0x0210}, + {HI846_REG_UNKNOWN_0B02, 0xE04D}, + {HI846_REG_UNKNOWN_0B10, 0x7021}, + {HI846_REG_UNKNOWN_0B12, 0x0120}, + {HI846_REG_UNKNOWN_0B14, 0x0001}, + {HI846_REG_UNKNOWN_2008, 0x38FD}, + {HI846_REG_UNKNOWN_326E, 0x0000}, +}; + +static const struct hi846_reg mode_640x480_mipi_2lane[] = { + {HI846_REG_UNKNOWN_0900, 0x0300}, + {HI846_REG_MIPI_TX_OP_MODE, 0x4319}, + {HI846_REG_UNKNOWN_0914, 0xC105}, + {HI846_REG_TCLK_PREPARE, 0x030C}, + {HI846_REG_UNKNOWN_0918, 0x0304}, + {HI846_REG_THS_ZERO, 0x0708}, + {HI846_REG_TCLK_POST, 0x0B04}, + {HI846_REG_UNKNOWN_091E, 0x0500}, + {HI846_REG_UNKNOWN_090C, 0x0208}, + {HI846_REG_UNKNOWN_090E, 0x009A}, + {HI846_REG_UNKNOWN_0954, 0x0089}, + {HI846_REG_UNKNOWN_0956, 0x0000}, + {HI846_REG_UNKNOWN_0958, 0xCA80}, + {HI846_REG_UNKNOWN_095A, 0x9240}, + {HI846_REG_PLL_CFG_MIPI2_H, 0x4924}, + {HI846_REG_TG_ENABLE, 0x0100}, +}; + +static const struct hi846_reg mode_1280x720_config[] = { + {HI846_REG_MODE_SELECT, 0x0000}, + {HI846_REG_Y_ODD_INC_FOBP, 0x3311}, + {HI846_REG_Y_ODD_INC_VACT, 0x3311}, + {HI846_REG_Y_ADDR_START_VACT_H, 0x0238}, + {HI846_REG_Y_ADDR_END_VACT_H, 0x07D7}, + {HI846_REG_UNKNOWN_005C, 0x4202}, + {HI846_REG_FLL, 0x034A}, + {HI846_REG_LLP, 0x0ED8}, + {HI846_REG_BINNING_MODE, 0x0122}, + {HI846_REG_HBIN_MODE, 0x0100}, + {HI846_REG_UNKNOWN_0A24, 0x0000}, + {HI846_REG_X_START_H, 0x00B0}, + {HI846_REG_X_OUTPUT_SIZE_H, 0x0500}, + {HI846_REG_Y_OUTPUT_SIZE_H, 0x02D0}, + {HI846_REG_EXPOSURE, 0x0344}, + + /* For OTP */ + {HI846_REG_UNKNOWN_021C, 0x0003}, + {HI846_REG_UNKNOWN_021E, 0x0235}, + + {HI846_REG_ISP_EN_H, 0x017A}, + {HI846_REG_UNKNOWN_0418, 0x0410}, + {HI846_REG_UNKNOWN_0B02, 0xE04D}, + {HI846_REG_UNKNOWN_0B10, 0x6C21}, + {HI846_REG_UNKNOWN_0B12, 0x0120}, + {HI846_REG_UNKNOWN_0B14, 0x0005}, + {HI846_REG_UNKNOWN_2008, 0x38FD}, + {HI846_REG_UNKNOWN_326E, 0x0000}, +}; + +static const struct hi846_reg mode_1280x720_mipi_2lane[] = { + {HI846_REG_UNKNOWN_0900, 0x0300}, + {HI846_REG_MIPI_TX_OP_MODE, 0x4319}, + {HI846_REG_UNKNOWN_0914, 0xC109}, + {HI846_REG_TCLK_PREPARE, 0x061A}, + {HI846_REG_UNKNOWN_0918, 0x0407}, + {HI846_REG_THS_ZERO, 0x0A0B}, + {HI846_REG_TCLK_POST, 0x0E08}, + {HI846_REG_UNKNOWN_091E, 0x0A00}, + {HI846_REG_UNKNOWN_090C, 0x0427}, + {HI846_REG_UNKNOWN_090E, 0x0145}, + {HI846_REG_UNKNOWN_0954, 0x0089}, + {HI846_REG_UNKNOWN_0956, 0x0000}, + {HI846_REG_UNKNOWN_0958, 0xCA80}, + {HI846_REG_UNKNOWN_095A, 0x9240}, + {HI846_REG_PLL_CFG_MIPI2_H, 0x4124}, + {HI846_REG_TG_ENABLE, 0x0100}, +}; + +static const struct hi846_reg mode_1280x720_mipi_4lane[] = { + /* 360Mbps */ + {HI846_REG_UNKNOWN_0900, 0x0300}, + {HI846_REG_MIPI_TX_OP_MODE, 0xC319}, + {HI846_REG_UNKNOWN_0914, 0xC105}, + {HI846_REG_TCLK_PREPARE, 0x030C}, + {HI846_REG_UNKNOWN_0918, 0x0304}, + {HI846_REG_THS_ZERO, 0x0708}, + {HI846_REG_TCLK_POST, 0x0B04}, + {HI846_REG_UNKNOWN_091E, 0x0500}, + {HI846_REG_UNKNOWN_090C, 0x0208}, + {HI846_REG_UNKNOWN_090E, 0x008A}, + {HI846_REG_UNKNOWN_0954, 0x0089}, + {HI846_REG_UNKNOWN_0956, 0x0000}, + {HI846_REG_UNKNOWN_0958, 0xCA80}, + {HI846_REG_UNKNOWN_095A, 0x9240}, + {HI846_REG_PLL_CFG_MIPI2_H, 0x4924}, + {HI846_REG_TG_ENABLE, 0x0100}, +}; + +static const struct hi846_reg mode_1632x1224_config[] = { + {HI846_REG_MODE_SELECT, 0x0000}, + {HI846_REG_Y_ODD_INC_FOBP, 0x3311}, + {HI846_REG_Y_ODD_INC_VACT, 0x3311}, + {HI846_REG_Y_ADDR_START_VACT_H, 0x0040}, + {HI846_REG_Y_ADDR_END_VACT_H, 0x09CF}, + {HI846_REG_UNKNOWN_005C, 0x4202}, + {HI846_REG_FLL, 0x09DE}, + {HI846_REG_LLP, 0x0ED8}, + {HI846_REG_BINNING_MODE, 0x0122}, + {HI846_REG_HBIN_MODE, 0x0100}, + {HI846_REG_UNKNOWN_0A24, 0x0000}, + {HI846_REG_X_START_H, 0x0000}, + {HI846_REG_X_OUTPUT_SIZE_H, 0x0660}, + {HI846_REG_Y_OUTPUT_SIZE_H, 0x04C8}, + {HI846_REG_EXPOSURE, 0x09D8}, + {HI846_REG_ISP_EN_H, 0x017A}, + + /* For OTP */ + {HI846_REG_UNKNOWN_021C, 0x0003}, + {HI846_REG_UNKNOWN_021E, 0x0235}, + + {HI846_REG_UNKNOWN_0418, 0x0000}, + {HI846_REG_UNKNOWN_0B02, 0xE04D}, + {HI846_REG_UNKNOWN_0B10, 0x6C21}, + {HI846_REG_UNKNOWN_0B12, 0x0120}, + {HI846_REG_UNKNOWN_0B14, 0x0005}, + {HI846_REG_UNKNOWN_2008, 0x38FD}, + {HI846_REG_UNKNOWN_326E, 0x0000}, +}; + +static const struct hi846_reg mode_1632x1224_mipi_2lane[] = { + {HI846_REG_UNKNOWN_0900, 0x0300}, + {HI846_REG_MIPI_TX_OP_MODE, 0x4319}, + {HI846_REG_UNKNOWN_0914, 0xC109}, + {HI846_REG_TCLK_PREPARE, 0x061A}, + {HI846_REG_UNKNOWN_0918, 0x0407}, + {HI846_REG_THS_ZERO, 0x0A0B}, + {HI846_REG_TCLK_POST, 0x0E08}, + {HI846_REG_UNKNOWN_091E, 0x0A00}, + {HI846_REG_UNKNOWN_090C, 0x0427}, + {HI846_REG_UNKNOWN_090E, 0x0069}, + {HI846_REG_UNKNOWN_0954, 0x0089}, + {HI846_REG_UNKNOWN_0956, 0x0000}, + {HI846_REG_UNKNOWN_0958, 0xCA80}, + {HI846_REG_UNKNOWN_095A, 0x9240}, + {HI846_REG_PLL_CFG_MIPI2_H, 0x4124}, + {HI846_REG_TG_ENABLE, 0x0100}, +}; + +static const struct hi846_reg mode_1632x1224_mipi_4lane[] = { + {HI846_REG_UNKNOWN_0900, 0x0300}, + {HI846_REG_MIPI_TX_OP_MODE, 0xC319}, + {HI846_REG_UNKNOWN_0914, 0xC105}, + {HI846_REG_TCLK_PREPARE, 0x030C}, + {HI846_REG_UNKNOWN_0918, 0x0304}, + {HI846_REG_THS_ZERO, 0x0708}, + {HI846_REG_TCLK_POST, 0x0B04}, + {HI846_REG_UNKNOWN_091E, 0x0500}, + {HI846_REG_UNKNOWN_090C, 0x0208}, + {HI846_REG_UNKNOWN_090E, 0x001C}, + {HI846_REG_UNKNOWN_0954, 0x0089}, + {HI846_REG_UNKNOWN_0956, 0x0000}, + {HI846_REG_UNKNOWN_0958, 0xCA80}, + {HI846_REG_UNKNOWN_095A, 0x9240}, + {HI846_REG_PLL_CFG_MIPI2_H, 0x4924}, + {HI846_REG_TG_ENABLE, 0x0100}, +}; + +static const char * const hi846_test_pattern_menu[] = { + "Disabled", + "Solid Colour", + "100% Colour Bars", + "Fade To Grey Colour Bars", + "PN9", + "Gradient Horizontal", + "Gradient Vertical", + "Check Board", + "Slant Pattern", + "Resolution Pattern", +}; + +#define FREQ_INDEX_640 0 +#define FREQ_INDEX_1280 1 +static const s64 hi846_link_freqs[] = { + [FREQ_INDEX_640] = 80000000, + [FREQ_INDEX_1280] = 200000000, +}; + +static const struct hi846_reg_list hi846_init_regs_list_2lane = { + .num_of_regs = ARRAY_SIZE(hi846_init_2lane), + .regs = hi846_init_2lane, +}; + +static const struct hi846_reg_list hi846_init_regs_list_4lane = { + .num_of_regs = ARRAY_SIZE(hi846_init_4lane), + .regs = hi846_init_4lane, +}; + +static const struct hi846_mode supported_modes[] = { + { + .width = 640, + .height = 480, + .link_freq_index = FREQ_INDEX_640, + .fps = 120, + .frame_len = 631, + .llp = HI846_LINE_LENGTH, + .reg_list_config = { + .num_of_regs = ARRAY_SIZE(mode_640x480_config), + .regs = mode_640x480_config, + }, + .reg_list_2lane = { + .num_of_regs = ARRAY_SIZE(mode_640x480_mipi_2lane), + .regs = mode_640x480_mipi_2lane, + }, + }, + { + .width = 1280, + .height = 720, + .link_freq_index = FREQ_INDEX_1280, + .fps = 90, + .frame_len = 842, + .llp = HI846_LINE_LENGTH, + .reg_list_config = { + .num_of_regs = ARRAY_SIZE(mode_1280x720_config), + .regs = mode_1280x720_config, + }, + .reg_list_2lane = { + .num_of_regs = ARRAY_SIZE(mode_1280x720_mipi_2lane), + .regs = mode_1280x720_mipi_2lane, + }, + .reg_list_4lane = { + .num_of_regs = ARRAY_SIZE(mode_1280x720_mipi_4lane), + .regs = mode_1280x720_mipi_4lane, + }, + }, + { + .width = 1632, + .height = 1224, + .link_freq_index = FREQ_INDEX_1280, + .fps = 30, + .frame_len = 2526, + .llp = HI846_LINE_LENGTH, + .reg_list_config = { + .num_of_regs = ARRAY_SIZE(mode_1632x1224_config), + .regs = mode_1632x1224_config, + }, + .reg_list_2lane = { + .num_of_regs = ARRAY_SIZE(mode_1632x1224_mipi_2lane), + .regs = mode_1632x1224_mipi_2lane, + }, + .reg_list_4lane = { + .num_of_regs = ARRAY_SIZE(mode_1632x1224_mipi_4lane), + .regs = mode_1632x1224_mipi_4lane, + }, + } +}; + +struct hi846_gpio { + int gpio; + int level; +}; + +struct hi846_datafmt { + u32 code; + enum v4l2_colorspace colorspace; +}; + +struct hi846 { + struct hi846_gpio rst_gpio; + struct regulator *vdd1_regulator; + struct regulator *vdd_regulator; + struct clk *clock; + struct hi846_datafmt *fmt; + struct v4l2_subdev sd; + struct media_pad pad; + struct v4l2_ctrl_handler ctrl_handler; + u8 nr_lanes; + + struct v4l2_ctrl *link_freq; + struct v4l2_ctrl *pixel_rate; + struct v4l2_ctrl *vblank; + struct v4l2_ctrl *hblank; + struct v4l2_ctrl *exposure; + + const struct hi846_mode *cur_mode; + struct mutex mutex; + bool streaming; +}; + +static struct hi846_datafmt hi846_colour_fmts[] = { + {HI846_MEDIA_BUS_FORMAT, V4L2_COLORSPACE_RAW}, +}; + +static struct hi846_datafmt *hi846_find_datafmt(u32 code) +{ + int i; + + for (i = 0; i < ARRAY_SIZE(hi846_colour_fmts); i++) + if (hi846_colour_fmts[i].code == code) + return hi846_colour_fmts + i; + + return NULL; +} + +static inline u8 hi846_get_link_freq_index(struct hi846 *hi846) +{ + return hi846->cur_mode->link_freq_index; +} + +static s64 hi846_get_link_freq(struct hi846 *hi846) +{ + u8 index = hi846_get_link_freq_index(hi846); + + return *(hi846_link_freqs + index); +} + +static u64 hi846_calc_pixel_rate(struct hi846 *hi846) +{ + s64 link_freq = hi846_get_link_freq(hi846); + u64 pixel_rate = link_freq * 2 * hi846->nr_lanes; + + do_div(pixel_rate, HI846_RGB_DEPTH); + + return pixel_rate; +} + +static int hi846_read_reg(struct hi846 *hi846, u16 reg, u8 *val) +{ + struct i2c_client *client = v4l2_get_subdevdata(&hi846->sd); + struct i2c_msg msgs[2]; + u8 addr_buf[2]; + u8 data_buf[1] = {0}; + int ret; + + put_unaligned_be16(reg, addr_buf); + msgs[0].addr = client->addr; + msgs[0].flags = 0; + msgs[0].len = sizeof(addr_buf); + msgs[0].buf = addr_buf; + msgs[1].addr = client->addr; + msgs[1].flags = I2C_M_RD; + msgs[1].len = 1; + msgs[1].buf = &data_buf[0]; + + ret = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs)); + if (ret != ARRAY_SIZE(msgs)) { + dev_err(&client->dev, "i2c read error: %d\n", ret); + return -EIO; + } + + *val = data_buf[0]; + + return 0; +} + +static int hi846_write_reg_16(struct hi846 *hi846, u16 reg, u16 val) +{ + struct i2c_client *client = v4l2_get_subdevdata(&hi846->sd); + u8 buf[6]; + + put_unaligned_be16(reg, buf); + put_unaligned_be32(val << 8 * 2, buf + 2); + if (i2c_master_send(client, buf, 4) != 4) + return -EIO; + + return 0; +} + +static int hi846_write_reg_list(struct hi846 *hi846, + const struct hi846_reg_list *r_list) +{ + struct i2c_client *client = v4l2_get_subdevdata(&hi846->sd); + unsigned int i; + int ret; + + for (i = 0; i < r_list->num_of_regs; i++) { + ret = hi846_write_reg_16(hi846, r_list->regs[i].address, + r_list->regs[i].val); + if (ret) { + dev_err_ratelimited(&client->dev, + "failed to write reg 0x%4.4x. error = %d", + r_list->regs[i].address, ret); + return ret; + } + } + + return 0; +} + +static int hi846_write_reg(struct hi846 *hi846, u16 reg, u8 val) +{ + struct i2c_client *client = v4l2_get_subdevdata(&hi846->sd); + u8 buf[3] = { reg >> 8, reg & 0xff, val }; + int ret; + + struct i2c_msg msg[] = { + { .addr = client->addr, .flags = 0, + .len = ARRAY_SIZE(buf), .buf = buf }, + }; + + ret = i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg)); + if (ret != ARRAY_SIZE(msg)) { + dev_err(&client->dev, "i2c write error\n"); + return -EIO; + } + + return 0; +} + +static int hi846_update_digital_gain(struct hi846 *hi846, u16 d_gain) +{ + int ret; + + ret = hi846_write_reg_16(hi846, HI846_REG_MWB_GR_GAIN_H, d_gain); + if (ret) + return ret; + + ret = hi846_write_reg_16(hi846, HI846_REG_MWB_GB_GAIN_H, d_gain); + if (ret) + return ret; + + ret = hi846_write_reg_16(hi846, HI846_REG_MWB_R_GAIN_H, d_gain); + if (ret) + return ret; + + return hi846_write_reg_16(hi846, HI846_REG_MWB_B_GAIN_H, d_gain); +} + +static int hi846_test_pattern(struct hi846 *hi846, u32 pattern) +{ + int ret; + u8 val; + + if (pattern) { + ret = hi846_read_reg(hi846, HI846_REG_ISP, &val); + if (ret) + return ret; + + ret = hi846_write_reg(hi846, HI846_REG_ISP, + val | HI846_REG_ISP_TPG_EN); + if (ret) + return ret; + } + + return hi846_write_reg(hi846, HI846_REG_TEST_PATTERN, pattern); +} + +static int hi846_set_ctrl(struct v4l2_ctrl *ctrl) +{ + struct hi846 *hi846 = container_of(ctrl->handler, + struct hi846, ctrl_handler); + struct i2c_client *client = v4l2_get_subdevdata(&hi846->sd); + s64 exposure_max; + int ret = 0; + u32 shutter, frame_len; + + if (!pm_runtime_get_if_in_use(&client->dev)) + goto out; + + /* Propagate change of current control to all related controls */ + if (ctrl->id == V4L2_CID_VBLANK) { + /* Update max exposure while meeting expected vblanking */ + exposure_max = hi846->cur_mode->height + ctrl->val - + HI846_EXPOSURE_MAX_MARGIN; + __v4l2_ctrl_modify_range(hi846->exposure, + hi846->exposure->minimum, + exposure_max, hi846->exposure->step, + exposure_max); + } + + switch (ctrl->id) { + case V4L2_CID_ANALOGUE_GAIN: + ret = hi846_write_reg(hi846, HI846_REG_ANALOG_GAIN, ctrl->val); + break; + + case V4L2_CID_DIGITAL_GAIN: + ret = hi846_update_digital_gain(hi846, ctrl->val); + break; + + case V4L2_CID_EXPOSURE: + shutter = ctrl->val; + frame_len = hi846->cur_mode->frame_len; + + if (shutter > frame_len - 6) { /* margin */ + frame_len = shutter + 6; + if (frame_len > 0xffff) { /* max frame len */ + frame_len = 0xffff; + } + } + + if (shutter < 6) + shutter = 6; + if (shutter > (0xffff - 6)) + shutter = 0xffff - 6; + + ret = hi846_write_reg_16(hi846, HI846_REG_FLL, + frame_len); + ret = hi846_write_reg_16(hi846, HI846_REG_EXPOSURE, + shutter); + break; + + case V4L2_CID_VBLANK: + /* Update FLL that meets expected vertical blanking */ + ret = hi846_write_reg_16(hi846, HI846_REG_FLL, + hi846->cur_mode->height + ctrl->val); + break; + case V4L2_CID_TEST_PATTERN: + ret = hi846_test_pattern(hi846, ctrl->val); + break; + + default: + ret = -EINVAL; + break; + } + + pm_runtime_put(&client->dev); +out: + return ret; +} + +static const struct v4l2_ctrl_ops hi846_ctrl_ops = { + .s_ctrl = hi846_set_ctrl, +}; + +static int hi846_init_controls(struct hi846 *hi846) +{ + struct v4l2_ctrl_handler *ctrl_hdlr; + s64 exposure_max, h_blank; + int ret; + struct i2c_client *client = v4l2_get_subdevdata(&hi846->sd); + + ctrl_hdlr = &hi846->ctrl_handler; + ret = v4l2_ctrl_handler_init(ctrl_hdlr, 8); + if (ret) + return ret; + + ctrl_hdlr->lock = &hi846->mutex; + + hi846->link_freq = v4l2_ctrl_new_int_menu(ctrl_hdlr, &hi846_ctrl_ops, + V4L2_CID_LINK_FREQ, + ARRAY_SIZE(hi846_link_freqs) - 1, + 0, hi846_link_freqs); + if (hi846->link_freq) + hi846->link_freq->flags |= V4L2_CTRL_FLAG_READ_ONLY; + + hi846->pixel_rate = v4l2_ctrl_new_std + (ctrl_hdlr, &hi846_ctrl_ops, + V4L2_CID_PIXEL_RATE, 0, + hi846_calc_pixel_rate(hi846), + 1, + hi846_calc_pixel_rate(hi846)); + hi846->vblank = v4l2_ctrl_new_std(ctrl_hdlr, &hi846_ctrl_ops, + V4L2_CID_VBLANK, + hi846->cur_mode->frame_len - + hi846->cur_mode->height, + HI846_FLL_MAX - + hi846->cur_mode->height, 1, + hi846->cur_mode->frame_len - + hi846->cur_mode->height); + + h_blank = hi846->cur_mode->llp - hi846->cur_mode->width; + + hi846->hblank = v4l2_ctrl_new_std(ctrl_hdlr, &hi846_ctrl_ops, + V4L2_CID_HBLANK, h_blank, h_blank, 1, + h_blank); + if (hi846->hblank) + hi846->hblank->flags |= V4L2_CTRL_FLAG_READ_ONLY; + + v4l2_ctrl_new_std(ctrl_hdlr, &hi846_ctrl_ops, V4L2_CID_ANALOGUE_GAIN, + HI846_ANAL_GAIN_MIN, HI846_ANAL_GAIN_MAX, + HI846_ANAL_GAIN_STEP, HI846_ANAL_GAIN_MIN); + v4l2_ctrl_new_std(ctrl_hdlr, &hi846_ctrl_ops, V4L2_CID_DIGITAL_GAIN, + HI846_DGTL_GAIN_MIN, HI846_DGTL_GAIN_MAX, + HI846_DGTL_GAIN_STEP, HI846_DGTL_GAIN_DEFAULT); + exposure_max = hi846->cur_mode->frame_len - HI846_EXPOSURE_MAX_MARGIN; + hi846->exposure = v4l2_ctrl_new_std(ctrl_hdlr, &hi846_ctrl_ops, + V4L2_CID_EXPOSURE, + HI846_EXPOSURE_MIN, exposure_max, + HI846_EXPOSURE_STEP, + exposure_max); + v4l2_ctrl_new_std_menu_items(ctrl_hdlr, &hi846_ctrl_ops, + V4L2_CID_TEST_PATTERN, + ARRAY_SIZE(hi846_test_pattern_menu) - 1, + 0, 0, hi846_test_pattern_menu); + if (ctrl_hdlr->error) { + dev_err(&client->dev, "v4l ctrl handler error: %d\n", + ctrl_hdlr->error); + return ctrl_hdlr->error; + } + + hi846->sd.ctrl_handler = ctrl_hdlr; + + return 0; +} + +static int hi846_set_video_mode(struct hi846 *hi846, int fps) +{ + struct i2c_client *client = v4l2_get_subdevdata(&hi846->sd); + int frame_length; + int ret; + int dummy_lines; + s64 link_freq = hi846_get_link_freq(hi846); + + dev_dbg(&client->dev, "%s: link freq: %lld\n", __func__, + hi846_get_link_freq(hi846)); + + frame_length = do_div(link_freq, do_div(fps, HI846_LINE_LENGTH)); + dummy_lines = (frame_length > hi846->cur_mode->frame_len) ? + (frame_length - hi846->cur_mode->frame_len) : 0; + + frame_length = hi846->cur_mode->frame_len + dummy_lines; + + dev_dbg(&client->dev, "%s: frame length calculated: %d\n", __func__, + frame_length); + + ret = hi846_write_reg_16(hi846, HI846_REG_FLL, frame_length & 0xFFFF); + ret = hi846_write_reg_16(hi846, HI846_REG_LLP, HI846_LINE_LENGTH & 0xFFFF); + + return ret; +} + +static int hi846_start_streaming(struct hi846 *hi846) +{ + struct i2c_client *client = v4l2_get_subdevdata(&hi846->sd); + int ret = 0; + u8 val; + + if (hi846->nr_lanes == 2) + ret = hi846_write_reg_list(hi846, &hi846_init_regs_list_2lane); + else + ret = hi846_write_reg_list(hi846, &hi846_init_regs_list_4lane); + if (ret) { + dev_err(&client->dev, "failed to set plls: %d\n", ret); + return ret; + } + + ret = hi846_write_reg_list(hi846, &hi846->cur_mode->reg_list_config); + if (ret) { + dev_err(&client->dev, "failed to set mode: %d\n", ret); + return ret; + } + + if (hi846->nr_lanes == 2) { + if (!&hi846->cur_mode->reg_list_2lane) { + dev_err(&client->dev, "2 lanes unsupported for this mode\n"); + return -EINVAL; + } + ret = hi846_write_reg_list(hi846, &hi846->cur_mode->reg_list_2lane); + } else { + if (!&hi846->cur_mode->reg_list_4lane) { + dev_err(&client->dev, "4 lanes unsupported for this mode\n"); + return -EINVAL; + } + ret = hi846_write_reg_list(hi846, &hi846->cur_mode->reg_list_4lane); + } + if (ret) { + dev_err(&client->dev, "failed to set mipi mode: %d\n", ret); + return ret; + } + + hi846_set_video_mode(hi846, hi846->cur_mode->fps); + + ret = __v4l2_ctrl_handler_setup(hi846->sd.ctrl_handler); + if (ret) + return ret; + + /* + * Reading 0x0034 is purely done for debugging reasons: It is not + * documented in the DS but only mentioned once: + * "If 0x0034[2] bit is disabled , Visible pixel width and height is 0." + * So even though that sounds like we won't see anything, we don't + * know more about this, so in that case only inform the user but do + * nothing more. + */ + ret = hi846_read_reg(hi846, 0x0034, &val); + if (ret) + return ret; + if (!(val & BIT(2))) + dev_info(&client->dev, "visible pixel width and height is 0\n"); + + ret = hi846_write_reg(hi846, HI846_REG_MODE_SELECT, + HI846_MODE_STREAMING); + if (ret) { + dev_err(&client->dev, "failed to start stream"); + return ret; + } + + hi846->streaming = 1; + + dev_dbg(&client->dev, "%s: started streaming successfully\n", __func__); + + return ret; +} + +static void hi846_stop_streaming(struct hi846 *hi846) +{ + struct i2c_client *client = v4l2_get_subdevdata(&hi846->sd); + + if (hi846_write_reg(hi846, HI846_REG_MODE_SELECT, HI846_MODE_STANDBY)) + dev_err(&client->dev, "failed to stop stream"); + + hi846->streaming = 0; +} + +static int hi846_set_stream(struct v4l2_subdev *sd, int enable) +{ + struct hi846 *hi846 = to_hi846(sd); + struct i2c_client *client = v4l2_get_subdevdata(sd); + int ret = 0; + + if (hi846->streaming == enable) + return 0; + + mutex_lock(&hi846->mutex); + + if (enable) { + ret = pm_runtime_get_sync(&client->dev); + if (ret < 0) { + pm_runtime_put_noidle(&client->dev); + goto out; + } + + ret = hi846_start_streaming(hi846); + if (ret) { + enable = 0; + hi846_stop_streaming(hi846); + pm_runtime_put(&client->dev); + } + } else { + hi846_stop_streaming(hi846); + pm_runtime_put(&client->dev); + } + +out: + mutex_unlock(&hi846->mutex); + + return ret; +} + +static int hi846_regulator_enable(struct hi846 *hi846) +{ + int ret = 0; + + ret = regulator_enable(hi846->vdd_regulator); + if (ret) + return ret; + + return regulator_enable(hi846->vdd1_regulator); +} + +static void hi846_regulator_disable(struct hi846 *hi846) +{ + if (regulator_is_enabled(hi846->vdd1_regulator)) + regulator_disable(hi846->vdd1_regulator); + + if (regulator_is_enabled(hi846->vdd_regulator)) + regulator_disable(hi846->vdd_regulator); +} + +static int __maybe_unused hi846_suspend(struct device *dev) +{ + struct i2c_client *client = to_i2c_client(dev); + struct v4l2_subdev *sd = i2c_get_clientdata(client); + struct hi846 *hi846 = to_hi846(sd); + + if (hi846->streaming) + hi846_stop_streaming(hi846); + + if (!IS_ERR(hi846->clock)) + clk_disable_unprepare(hi846->clock); + + hi846_regulator_disable(hi846); + + return 0; +} + +static int __maybe_unused hi846_resume(struct device *dev) +{ + struct i2c_client *client = to_i2c_client(dev); + struct v4l2_subdev *sd = i2c_get_clientdata(client); + struct hi846 *hi846 = to_hi846(sd); + int ret; + + ret = hi846_regulator_enable(hi846); + if (ret) { + dev_err(dev, "enable regulator failed: %d\n", ret); + return ret; + } + + ret = clk_prepare_enable(hi846->clock); + if (ret < 0) { + dev_err(dev, "enable clk failed: %d\n", ret); + goto error_regulator; + } + + msleep(100); + + if (hi846->streaming) { + ret = hi846_start_streaming(hi846); + if (ret) { + dev_err(dev, "%s: start streaming failed: %d\n", + __func__, ret); + goto error; + } + } + + return 0; + +error: + clk_disable_unprepare(hi846->clock); + +error_regulator: + hi846_regulator_disable(hi846); + + return ret; +} + +static int hi846_set_format(struct v4l2_subdev *sd, + struct v4l2_subdev_pad_config *cfg, + struct v4l2_subdev_format *format) +{ + struct hi846 *hi846 = to_hi846(sd); + struct v4l2_mbus_framefmt *mf = &format->format; + struct i2c_client *client = v4l2_get_subdevdata(sd); + struct hi846_datafmt *fmt = hi846_find_datafmt(mf->code); + u32 tgt_fps; + s32 vblank_def, h_blank; + + if (!fmt) { + mf->code = hi846_colour_fmts[0].code; + mf->colorspace = hi846_colour_fmts[0].colorspace; + fmt = &hi846_colour_fmts[0]; + } + + if (format->which == V4L2_SUBDEV_FORMAT_TRY) { + *v4l2_subdev_get_try_format(sd, cfg, format->pad) = *mf; + return 0; + } + + mutex_lock(&hi846->mutex); + + if (hi846->streaming) { + mutex_unlock(&hi846->mutex); + return -EBUSY; + } + + hi846->fmt = fmt; + + hi846->cur_mode = v4l2_find_nearest_size(supported_modes, + ARRAY_SIZE(supported_modes), width, + height, mf->width, + mf->height); + dev_dbg(&client->dev, "%s: found mode: %dx%d\n", __func__, + hi846->cur_mode->width, hi846->cur_mode->height); + + tgt_fps = hi846->cur_mode->fps; + dev_dbg(&client->dev, "%s: target fps: %d\n", __func__, tgt_fps); + + mf->width = hi846->cur_mode->width; + mf->height = hi846->cur_mode->height; + mf->code = HI846_MEDIA_BUS_FORMAT; + mf->field = V4L2_FIELD_NONE; + + __v4l2_ctrl_s_ctrl(hi846->link_freq, hi846_get_link_freq_index(hi846)); + __v4l2_ctrl_s_ctrl_int64(hi846->pixel_rate, + hi846_calc_pixel_rate(hi846)); + + /* Update limits and set FPS to default */ + vblank_def = hi846->cur_mode->frame_len - hi846->cur_mode->height; + __v4l2_ctrl_modify_range(hi846->vblank, + hi846->cur_mode->frame_len - hi846->cur_mode->height, + HI846_FLL_MAX - hi846->cur_mode->height, 1, + vblank_def); + __v4l2_ctrl_s_ctrl(hi846->vblank, vblank_def); + + h_blank = hi846->cur_mode->llp - hi846->cur_mode->width; + + __v4l2_ctrl_modify_range(hi846->hblank, h_blank, h_blank, 1, + h_blank); + + dev_dbg(&client->dev, "Set fmt w=%d h=%d code=0x%x colorspace=0x%x\n", + mf->width, mf->height, + fmt->code, fmt->colorspace); + + mutex_unlock(&hi846->mutex); + + return 0; +} + +static int hi846_get_format(struct v4l2_subdev *sd, + struct v4l2_subdev_pad_config *cfg, + struct v4l2_subdev_format *format) +{ + struct hi846 *hi846 = to_hi846(sd); + struct v4l2_mbus_framefmt *mf = &format->format; + struct i2c_client *client = v4l2_get_subdevdata(sd); + + if (format->pad) + return -EINVAL; + + if (format->which == V4L2_SUBDEV_FORMAT_TRY) { + format->format = *v4l2_subdev_get_try_format(&hi846->sd, + cfg, + format->pad); + return 0; + } + + mutex_lock(&hi846->mutex); + mf->code = HI846_MEDIA_BUS_FORMAT; + mf->colorspace = V4L2_COLORSPACE_RAW; + mf->field = V4L2_FIELD_NONE; + mf->width = hi846->cur_mode->width; + mf->height = hi846->cur_mode->height; + mutex_unlock(&hi846->mutex); + dev_dbg(&client->dev, + "Get format w=%d h=%d code=0x%x colorspace=0x%x\n", + mf->width, mf->height, mf->code, mf->colorspace); + + return 0; +} + +static int hi846_enum_mbus_code(struct v4l2_subdev *sd, + struct v4l2_subdev_pad_config *cfg, + struct v4l2_subdev_mbus_code_enum *code) +{ + if (code->pad || code->index > 0) + return -EINVAL; + + code->code = HI846_MEDIA_BUS_FORMAT; + + return 0; +} + +static int hi846_enum_frame_size(struct v4l2_subdev *sd, + struct v4l2_subdev_pad_config *cfg, + struct v4l2_subdev_frame_size_enum *fse) +{ + struct i2c_client *client = v4l2_get_subdevdata(sd); + + if (fse->pad || fse->index >= ARRAY_SIZE(supported_modes)) + return -EINVAL; + + if (fse->code != HI846_MEDIA_BUS_FORMAT) { + dev_err(&client->dev, "frame size enum not matching\n"); + return -EINVAL; + } + + fse->min_width = supported_modes[fse->index].width; + fse->max_width = supported_modes[fse->index].width; + fse->min_height = supported_modes[fse->index].height; + fse->max_height = supported_modes[fse->index].height; + + dev_dbg(&client->dev, "%s: max width: %d max height: %d\n", __func__, + fse->max_width, fse->max_height); + + return 0; +} + +static int hi846_s_power(struct v4l2_subdev *sd, int on) +{ + struct hi846 *hi846 = to_hi846(sd); + struct i2c_client *client = v4l2_get_subdevdata(sd); + struct device *dev = &client->dev; + int ret = 0; + + mutex_lock(&hi846->mutex); + if (on) { + ret = hi846_resume(dev); + if (ret) + goto out; + } else { + ret = hi846_suspend(dev); + if (ret) + goto out; + } +out: + mutex_unlock(&hi846->mutex); + return ret; +} + +static int hi846_open(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh) +{ + struct hi846 *hi846 = to_hi846(sd); + struct v4l2_mbus_framefmt *mf; + + mf = v4l2_subdev_get_try_format(sd, fh->pad, 0); + + mutex_lock(&hi846->mutex); + mf->code = HI846_MEDIA_BUS_FORMAT; + mf->colorspace = V4L2_COLORSPACE_RAW; + mf->field = V4L2_FIELD_NONE; + mf->width = hi846->cur_mode->width; + mf->height = hi846->cur_mode->height; + mutex_unlock(&hi846->mutex); + + return 0; +} + +static const struct v4l2_subdev_video_ops hi846_video_ops = { + .s_stream = hi846_set_stream, +}; + +static const struct v4l2_subdev_pad_ops hi846_pad_ops = { + .enum_frame_size = hi846_enum_frame_size, + .enum_mbus_code = hi846_enum_mbus_code, + .set_fmt = hi846_set_format, + .get_fmt = hi846_get_format, +}; + +static struct v4l2_subdev_core_ops hi846_core_ops = { + .s_power = hi846_s_power, + .log_status = v4l2_ctrl_subdev_log_status, +}; + +static const struct v4l2_subdev_ops hi846_subdev_ops = { + .core = &hi846_core_ops, + .video = &hi846_video_ops, + .pad = &hi846_pad_ops, +}; + +static const struct media_entity_operations hi846_subdev_entity_ops = { + .link_validate = v4l2_subdev_link_validate, +}; + +static const struct v4l2_subdev_internal_ops hi846_internal_ops = { + .open = hi846_open, +}; + +static void hi846_rst_gpio_assert(struct hi846 *hi846, bool on) +{ + struct hi846_gpio *gpio = &hi846->rst_gpio; + + if (gpio == NULL) + return; + + if (on) + gpio_set_value(gpio->gpio, gpio->level); + else + gpio_set_value(gpio->gpio, !gpio->level); +} + +static int hi846_parse_gpio(struct hi846_gpio *gpio, struct device *dev) +{ + struct device_node *node = dev->of_node; + enum of_gpio_flags flags; + int ret; + + ret = of_get_named_gpio_flags(node, "reset-gpios", 0, &flags); + if (ret < 0) { + dev_err(dev, "no reset-gpios provided: %d\n", ret); + return ret; + } + gpio->gpio = ret; + gpio->level = !(flags & OF_GPIO_ACTIVE_LOW); + + return 0; +} + +static int hi846_identify_module(struct hi846 *hi846) +{ + struct i2c_client *client = v4l2_get_subdevdata(&hi846->sd); + int ret; + u8 hi, lo; + + ret = hi846_read_reg(hi846, HI846_REG_CHIP_ID_L, &lo); + if (ret) + return ret; + + if (lo != HI846_CHIP_ID_L) { + dev_err(&client->dev, "wrong chip id low byte: %x", lo); + return -ENXIO; + } + + ret = hi846_read_reg(hi846, HI846_REG_CHIP_ID_H, &hi); + if (ret) + return ret; + + if (hi != HI846_CHIP_ID_H) { + dev_err(&client->dev, "wrong chip id high byte: %x", hi); + return -ENXIO; + } + + dev_info(&client->dev, "chip id %02X %02X using %d mipi lanes\n", hi, lo, + hi846->nr_lanes); + + return 0; +} + +static int hi846_check_hwcfg(struct device *dev, u8 *lanes) +{ + struct fwnode_handle *ep; + struct fwnode_handle *fwnode = dev_fwnode(dev); + struct v4l2_fwnode_endpoint bus_cfg = { + .bus_type = V4L2_MBUS_CSI2_DPHY + }; + int ret = 0; + + if (!fwnode) + return -ENXIO; + + ep = fwnode_graph_get_next_endpoint(fwnode, NULL); + if (!ep) + return -ENXIO; + + ret = v4l2_fwnode_endpoint_alloc_parse(ep, &bus_cfg); + fwnode_handle_put(ep); + if (ret) + return ret; + + if (bus_cfg.bus.mipi_csi2.num_data_lanes != 2 && + bus_cfg.bus.mipi_csi2.num_data_lanes != 4) { + dev_err(dev, "number of CSI2 data lanes %d is not supported", + bus_cfg.bus.mipi_csi2.num_data_lanes); + ret = -EINVAL; + goto check_hwcfg_error; + } + + *lanes = bus_cfg.bus.mipi_csi2.num_data_lanes; + +check_hwcfg_error: + v4l2_fwnode_endpoint_free(&bus_cfg); + + return ret; +} + +static int hi846_remove(struct i2c_client *client) +{ + struct v4l2_subdev *sd = i2c_get_clientdata(client); + struct hi846 *hi846 = to_hi846(sd); + + v4l2_async_unregister_subdev(sd); + media_entity_cleanup(&sd->entity); + v4l2_ctrl_handler_free(sd->ctrl_handler); + + pm_runtime_disable(&client->dev); + if (!pm_runtime_status_suspended(&client->dev)) + hi846_suspend(&client->dev); + pm_runtime_set_suspended(&client->dev); + + mutex_destroy(&hi846->mutex); + + return 0; +} + +static int hi846_probe(struct i2c_client *client) +{ + struct hi846 *hi846; + int ret; + u8 lanes; + + ret = hi846_check_hwcfg(&client->dev, &lanes); + if (ret) { + dev_err(&client->dev, "failed to check HW configuration: %d", + ret); + return ret; + } + + hi846 = devm_kzalloc(&client->dev, sizeof(*hi846), GFP_KERNEL); + if (!hi846) + return -ENOMEM; + + hi846->nr_lanes = lanes; + + v4l2_i2c_subdev_init(&hi846->sd, client, &hi846_subdev_ops); + + ret = hi846_parse_gpio(&hi846->rst_gpio, &client->dev); + if (ret < 0) { + dev_err(&client->dev, "parse gpio failed: %d\n", ret); + return ret; + } + + hi846->vdd_regulator = devm_regulator_get(&client->dev, "vdd"); + if (IS_ERR(hi846->vdd_regulator)) + dev_warn(&client->dev, "cannot get voltage regulator\n"); + + hi846->vdd1_regulator = devm_regulator_get(&client->dev, "vdd1"); + if (IS_ERR(hi846->vdd1_regulator)) + dev_warn(&client->dev, "cannot get voltage regulator\n"); + + ret = hi846_regulator_enable(hi846); + if (ret) { + dev_err(&client->dev, "regulator enable failed: %d\n", ret); + return ret; + } + + hi846->clock = devm_clk_get(hi846->sd.dev, "mclk"); + if (IS_ERR(hi846->clock)) { + dev_err(&client->dev, "get clk failed\n"); + ret = -EPROBE_DEFER; + goto probe_error_regulator; + } + + ret = clk_prepare_enable(hi846->clock); + if (ret < 0) + goto probe_error_regulator; + + msleep(100); + + hi846_rst_gpio_assert(hi846, true); + + ret = hi846_identify_module(hi846); + if (ret) { + dev_err(&client->dev, "failed to find sensor: %d", ret); + goto probe_error_regulator; + } + + mutex_init(&hi846->mutex); + + hi846->cur_mode = &supported_modes[0]; + ret = hi846_init_controls(hi846); + if (ret) { + dev_err(&client->dev, "failed to init controls: %d", ret); + goto probe_error_v4l2_ctrl_handler_free; + } + + hi846->sd.internal_ops = &hi846_internal_ops; + hi846->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE; + hi846->sd.entity.ops = &hi846_subdev_entity_ops; + hi846->sd.entity.function = MEDIA_ENT_F_CAM_SENSOR; + hi846->pad.flags = MEDIA_PAD_FL_SOURCE; + ret = media_entity_pads_init(&hi846->sd.entity, 1, &hi846->pad); + if (ret) { + dev_err(&client->dev, "failed to init entity pads: %d", ret); + goto probe_error_v4l2_ctrl_handler_free; + } + + ret = v4l2_async_register_subdev_sensor(&hi846->sd); + if (ret < 0) { + dev_err(&client->dev, "failed to register V4L2 subdev: %d", + ret); + goto probe_error_media_entity_cleanup; + } + + pm_runtime_set_active(&client->dev); + pm_runtime_enable(&client->dev); + pm_runtime_idle(&client->dev); + + return 0; + +probe_error_media_entity_cleanup: + media_entity_cleanup(&hi846->sd.entity); + +probe_error_v4l2_ctrl_handler_free: + v4l2_ctrl_handler_free(hi846->sd.ctrl_handler); + mutex_destroy(&hi846->mutex); + +probe_error_regulator: + hi846_regulator_disable(hi846); + + return ret; +} + +static UNIVERSAL_DEV_PM_OPS(hi846_pm_ops, hi846_suspend, hi846_resume, NULL); + +static const struct of_device_id hi846_of_match[] = { + { .compatible = "hynix,hi846", }, + {}, +}; +MODULE_DEVICE_TABLE(of, hi846_of_match); + +static struct i2c_driver hi846_i2c_driver = { + .driver = { + .name = "hi846", + .pm = &hi846_pm_ops, + .of_match_table = of_match_ptr(hi846_of_match), + }, + .probe_new = hi846_probe, + .remove = hi846_remove, +}; + +module_i2c_driver(hi846_i2c_driver); + +MODULE_AUTHOR("Angus Ainslie <angus@akkea.ca>"); +MODULE_AUTHOR("Martin Kepplinger <martin.kepplinger@puri.sm>"); +MODULE_DESCRIPTION("Hynix HI846 sensor driver"); +MODULE_LICENSE("GPL v2"); -- 2.30.2 ^ permalink raw reply related [flat|nested] 14+ messages in thread
* Re: [PATCH v3 3/5] media: i2c: add driver for the SK Hynix Hi-846 8M pixel camera 2021-05-31 12:07 ` [PATCH v3 3/5] media: i2c: add driver for the SK Hynix Hi-846 8M pixel camera Martin Kepplinger @ 2021-06-01 0:14 ` Laurent Pinchart 2021-06-02 12:00 ` Martin Kepplinger 2021-06-01 6:50 ` kernel test robot 1 sibling, 1 reply; 14+ messages in thread From: Laurent Pinchart @ 2021-06-01 0:14 UTC (permalink / raw) To: Martin Kepplinger Cc: pavel, krzysztof.kozlowski, mchehab, paul.kocialkowski, robh, shawnx.tu, devicetree, kernel, linux-kernel, linux-media, phone-devel Hi Martin, Thank you for the patch. On Mon, May 31, 2021 at 02:07:35PM +0200, Martin Kepplinger wrote: > The SK Hynix Hi-846 is a 1/4" 8M Pixel CMOS Image Sensor. It supports > usual features like I2C control, CSI-2 for frame data, digital/analog > gain control or test patterns. > > This driver supports the 640x480, 1280x720 and 1632x1224 resolution > modes. It supports runtime PM in order not to draw any unnecessary power. > > The part is also called YACG4D0C9SHC and a datasheet can be found at > https://product.skhynix.com/products/cis/cis.go > > The large sets of partly undocumented register values are for example > found when searching for the hi846_mipi_raw_Sensor.c Android driver. A common story, unfortunately :-S I've done an initial review, I'll likely have more comments on v4, but you should have quite a few things to address already :-) > Signed-off-by: Martin Kepplinger <martin.kepplinger@puri.sm> > --- > MAINTAINERS | 6 + > drivers/media/i2c/Kconfig | 13 + > drivers/media/i2c/Makefile | 1 + > drivers/media/i2c/hi846.c | 2138 ++++++++++++++++++++++++++++++++++++ > 4 files changed, 2158 insertions(+) > create mode 100644 drivers/media/i2c/hi846.c > > diff --git a/MAINTAINERS b/MAINTAINERS > index 503fd21901f1..27283b289123 100644 > --- a/MAINTAINERS > +++ b/MAINTAINERS > @@ -8432,6 +8432,12 @@ S: Maintained > T: git git://linuxtv.org/media_tree.git > F: drivers/media/i2c/hi556.c > > +HYNIX HI846 SENSOR DRIVER > +M: Martin Kepplinger <martin.kepplinger@puri.sm> > +L: linux-media@vger.kernel.org > +S: Maintained > +F: drivers/media/i2c/hi846.c > + > Hyper-V/Azure CORE AND DRIVERS > M: "K. Y. Srinivasan" <kys@microsoft.com> > M: Haiyang Zhang <haiyangz@microsoft.com> > diff --git a/drivers/media/i2c/Kconfig b/drivers/media/i2c/Kconfig > index 462c0e059754..f8cf5bf8eb68 100644 > --- a/drivers/media/i2c/Kconfig > +++ b/drivers/media/i2c/Kconfig > @@ -738,6 +738,19 @@ config VIDEO_HI556 > To compile this driver as a module, choose M here: the > module will be called hi556. > > +config VIDEO_HI846 > + tristate "Hynix Hi-846 sensor support" > + depends on I2C && VIDEO_V4L2 > + select MEDIA_CONTROLLER > + select VIDEO_V4L2_SUBDEV_API > + select V4L2_FWNODE > + help > + This is a Video4Linux2 sensor driver for the Hynix > + Hi-846 camera. > + > + To compile this driver as a module, choose M here: the > + module will be called hi846. > + > config VIDEO_IMX214 > tristate "Sony IMX214 sensor support" > depends on GPIOLIB && I2C && VIDEO_V4L2 > diff --git a/drivers/media/i2c/Makefile b/drivers/media/i2c/Makefile > index 0c067beca066..1194c5e6708b 100644 > --- a/drivers/media/i2c/Makefile > +++ b/drivers/media/i2c/Makefile > @@ -116,6 +116,7 @@ obj-$(CONFIG_VIDEO_ML86V7667) += ml86v7667.o > obj-$(CONFIG_VIDEO_OV2659) += ov2659.o > obj-$(CONFIG_VIDEO_TC358743) += tc358743.o > obj-$(CONFIG_VIDEO_HI556) += hi556.o > +obj-$(CONFIG_VIDEO_HI846) += hi846.o > obj-$(CONFIG_VIDEO_IMX214) += imx214.o > obj-$(CONFIG_VIDEO_IMX219) += imx219.o > obj-$(CONFIG_VIDEO_IMX258) += imx258.o > diff --git a/drivers/media/i2c/hi846.c b/drivers/media/i2c/hi846.c > new file mode 100644 > index 000000000000..80d1ccb15123 > --- /dev/null > +++ b/drivers/media/i2c/hi846.c > @@ -0,0 +1,2138 @@ > +// SPDX-License-Identifier: GPL-2.0 > +// Copyright (c) 2021 Purism SPC > + > +#include <asm/unaligned.h> > +#include <linux/clk.h> > +#include <linux/delay.h> > +#include <linux/gpio.h> > +#include <linux/i2c.h> > +#include <linux/module.h> > +#include <linux/of_gpio.h> > +#include <linux/of_graph.h> > +#include <linux/regulator/consumer.h> > +#include <linux/pm_runtime.h> > +#include <linux/pm.h> Please keep the headers sorted alphabetically. > +#include <media/v4l2-ctrls.h> > +#include <media/v4l2-device.h> > +#include <media/v4l2-fwnode.h> > + > + > +#define HI846_MEDIA_BUS_FORMAT MEDIA_BUS_FMT_SGBRG10_1X10 > +#define HI846_RGB_DEPTH 10 > +#define DEFAULT_FPS 30 Not used. > + > +/* Frame length lines / Vertical timings */ > +#define HI846_REG_FLL 0x0006 > +#define HI846_FLL_MAX 0xffff > + > +/* Horizontal timing */ > +#define HI846_REG_LLP 0x0008 > +#define HI846_LINE_LENGTH 3800 > + > +#define HI846_REG_BINNING_MODE 0x000c > + > +#define HI846_REG_IMAGE_ORIENTATION 0x000e > + > +#define HI846_REG_UNKNOWN_0022 0x0022 > + > +#define HI846_REG_Y_ADDR_START_VACT_H 0x0026 > +#define HI846_REG_Y_ADDR_START_VACT_L 0x0027 > +#define HI846_REG_UNKNOWN_0028 0x0028 > + > +#define HI846_REG_Y_ADDR_END_VACT_H 0x002c > +#define HI846_REG_Y_ADDR_END_VACT_L 0x002d > + > +#define HI846_REG_Y_ODD_INC_FOBP 0x002e > +#define HI846_REG_Y_EVEN_INC_FOBP 0x002f > + > +#define HI846_REG_Y_ODD_INC_VACT 0x0032 > +#define HI846_REG_Y_EVEN_INC_VACT 0x0033 > + > +#define HI846_REG_GROUPED_PARA_HOLD 0x0046 > + > +#define HI846_REG_TG_ENABLE 0x004c > + > +#define HI846_REG_UNKNOWN_005C 0x005c > + > +#define HI846_REG_UNKNOWN_006A 0x006a > + > +/* Long exposure time. Actually, exposure is a 20 bit value that The kernel coding style starts multi-line comments with '/*' on a line of its own. > + * includes the lower 4 bits of 0x0073 too. only 16 bit are used > + * right now > + */ > +#define HI846_REG_EXPOSURE 0x0074 > +#define HI846_EXPOSURE_MIN 6 > +#define HI846_EXPOSURE_MAX_MARGIN 2 > +#define HI846_EXPOSURE_STEP 1 > + > +/* Analog gain controls from sensor */ > +#define HI846_REG_ANALOG_GAIN 0x0077 > +#define HI846_ANAL_GAIN_MIN 0 > +#define HI846_ANAL_GAIN_MAX 240 > +#define HI846_ANAL_GAIN_STEP 8 > + > +/* Digital gain controls from sensor */ > +#define HI846_REG_MWB_GR_GAIN_H 0x0078 > +#define HI846_REG_MWB_GR_GAIN_L 0x0079 > +#define HI846_REG_MWB_GB_GAIN_H 0x007a > +#define HI846_REG_MWB_GB_GAIN_L 0x007b > +#define HI846_REG_MWB_R_GAIN_H 0x007c > +#define HI846_REG_MWB_R_GAIN_L 0x007d > +#define HI846_REG_MWB_B_GAIN_H 0x007e > +#define HI846_REG_MWB_B_GAIN_L 0x007f > +#define HI846_DGTL_GAIN_MIN 0 > +#define HI846_DGTL_GAIN_MAX 8191 > +#define HI846_DGTL_GAIN_STEP 1 > +#define HI846_DGTL_GAIN_DEFAULT 256 > + > +#define HI846_REG_X_ADDR_START_HACT_H 0x0120 > +#define HI846_REG_X_ADDR_END_HACT_H 0x0122 > + > +#define HI846_REG_UNKNOWN_012A 0x012a > + > +#define HI846_REG_UNKNOWN_0200 0x0200 > + > +#define HI846_REG_UNKNOWN_021C 0x021c > +#define HI846_REG_UNKNOWN_021E 0x021e > + > +#define HI846_REG_UNKNOWN_0402 0x0402 > +#define HI846_REG_UNKNOWN_0404 0x0404 > +#define HI846_REG_UNKNOWN_0408 0x0408 > +#define HI846_REG_UNKNOWN_0410 0x0410 > +#define HI846_REG_UNKNOWN_0412 0x0412 > +#define HI846_REG_UNKNOWN_0414 0x0414 > + > +#define HI846_REG_UNKNOWN_0418 0x0418 > + > +#define HI846_REG_UNKNOWN_051E 0x051e > + > +/* Formatter */ > +#define HI846_REG_X_START_H 0x0804 > +#define HI846_REG_X_START_L 0x0805 > + > +/* MIPI */ > +#define HI846_REG_UNKNOWN_0900 0x0900 > +#define HI846_REG_MIPI_TX_OP_EN 0x0901 > +#define HI846_REG_MIPI_TX_OP_MODE 0x0902 > +#define HI846_RAW8 BIT(5) > + > +#define HI846_REG_UNKNOWN_090C 0x090c > +#define HI846_REG_UNKNOWN_090E 0x090e > + > +#define HI846_REG_UNKNOWN_0914 0x0914 > +#define HI846_REG_TLPX 0x0915 > +#define HI846_REG_TCLK_PREPARE 0x0916 > +#define HI846_REG_TCLK_ZERO 0x0917 > +#define HI846_REG_UNKNOWN_0918 0x0918 > +#define HI846_REG_THS_PREPARE 0x0919 > +#define HI846_REG_THS_ZERO 0x091a > +#define HI846_REG_THS_TRAIL 0x091b > +#define HI846_REG_TCLK_POST 0x091c > +#define HI846_REG_TCLK_TRAIL_MIN 0x091d > +#define HI846_REG_UNKNOWN_091E 0x091e > + > +#define HI846_REG_UNKNOWN_0954 0x0954 > +#define HI846_REG_UNKNOWN_0956 0x0956 > +#define HI846_REG_UNKNOWN_0958 0x0958 > +#define HI846_REG_UNKNOWN_095A 0x095a > + > +/* ISP Common */ > +#define HI846_REG_MODE_SELECT 0x0a00 > +#define HI846_MODE_STANDBY 0x00 > +#define HI846_MODE_STREAMING 0x01 > +#define HI846_REG_FAST_STANDBY_MODE 0x0a02 > +#define HI846_REG_ISP_EN_H 0x0a04 > + > +/* Test Pattern Control */ > +#define HI846_REG_ISP 0x0a05 > +#define HI846_REG_ISP_TPG_EN 0x01 > +#define HI846_REG_TEST_PATTERN 0x020a /* 1-9 */ > + > +#define HI846_REG_UNKNOWN_0A0C 0x0a0c > + > +/* Windowing */ > +#define HI846_REG_X_OUTPUT_SIZE_H 0x0a12 > +#define HI846_REG_X_OUTPUT_SIZE_L 0x0a13 > +#define HI846_REG_Y_OUTPUT_SIZE_H 0x0a14 > +#define HI846_REG_Y_OUTPUT_SIZE_L 0x0a15 > + > +/* ISP Common */ > +#define HI846_REG_PEDESTAL_EN 0x0a1a > + > +#define HI846_REG_UNKNOWN_0A1E 0x0a1e > + > +/* Horizontal Binning Mode */ > +#define HI846_REG_HBIN_MODE 0x0a22 > + > +#define HI846_REG_UNKNOWN_0A24 0x0a24 > +#define HI846_REG_UNKNOWN_0B02 0x0b02 > +#define HI846_REG_UNKNOWN_0B10 0x0b10 > +#define HI846_REG_UNKNOWN_0B12 0x0b12 > +#define HI846_REG_UNKNOWN_0B14 0x0b14 > + > +/* BLC (Black Level Calibration) */ > +#define HI846_REG_BLC_CTL0 0x0c00 > + > +#define HI846_REG_UNKNOWN_0C06 0x0c06 > +#define HI846_REG_UNKNOWN_0C10 0x0c10 > +#define HI846_REG_UNKNOWN_0C12 0x0c12 > +#define HI846_REG_UNKNOWN_0C14 0x0c14 > +#define HI846_REG_UNKNOWN_0C16 0x0c16 > + > +#define HI846_REG_UNKNOWN_0E04 0x0e04 > + > +#define HI846_REG_CHIP_ID_L 0x0f16 > +#define HI846_REG_CHIP_ID_H 0x0f17 > +#define HI846_CHIP_ID_L 0x46 > +#define HI846_CHIP_ID_H 0x08 > + > +#define HI846_REG_UNKNOWN_0F04 0x0f04 > +#define HI846_REG_UNKNOWN_0F08 0x0f08 > + > +/* PLL */ > +#define HI846_REG_PLL_CFG_MIPI2_H 0x0f2a > +#define HI846_REG_PLL_CFG_MIPI2_L 0x0f2b > + > +#define HI846_REG_UNKNOWN_0F30 0x0f30 > +#define HI846_REG_PLL_CFG_RAMP1_H 0x0f32 > +#define HI846_REG_UNKNOWN_0F36 0x0f36 > +#define HI846_REG_PLL_CFG_MIPI1_H 0x0f38 > + > +#define HI846_REG_UNKNOWN_2008 0x2008 > +#define HI846_REG_UNKNOWN_326E 0x326e > + > +struct hi846_reg { > + u16 address; > + u16 val; > +}; > + > +struct hi846_reg_list { > + u32 num_of_regs; > + const struct hi846_reg *regs; > +}; > + > +struct hi846_mode { > + /* Frame width in pixels */ > + u32 width; > + > + /* Frame height in pixels */ > + u32 height; > + > + /* Horizontal timing size */ > + u32 llp; > + > + /* Link frequency needed for this resolution */ > + u8 link_freq_index; > + > + u16 fps; > + > + /* vertical timining size */ > + u16 frame_len; > + > + const struct hi846_reg_list reg_list_config; > + const struct hi846_reg_list reg_list_2lane; > + const struct hi846_reg_list reg_list_4lane; > +}; > + > +#define to_hi846(_sd) container_of(_sd, struct hi846, sd) Could you replace the macro with an inline function ? It provides additional compile-time type checks. > + > +static const struct hi846_reg hi846_init_2lane[] = { > + {HI846_REG_MODE_SELECT, 0x0000}, > + /* regs below are unknown */ > + {0x2000, 0x100A}, Lower-case for hex constants please. > + {0x2002, 0x00FF}, > + {0x2004, 0x0007}, > + {0x2006, 0x3FFF}, > + {0x2008, 0x3FFF}, > + {0x200A, 0xC216}, > + {0x200C, 0x1292}, > + {0x200E, 0xC01A}, > + {0x2010, 0x403D}, > + {0x2012, 0x000E}, > + {0x2014, 0x403E}, > + {0x2016, 0x0B80}, > + {0x2018, 0x403F}, > + {0x201A, 0x82AE}, > + {0x201C, 0x1292}, > + {0x201E, 0xC00C}, > + {0x2020, 0x4130}, > + {0x2022, 0x43E2}, > + {0x2024, 0x0180}, > + {0x2026, 0x4130}, > + {0x2028, 0x7400}, > + {0x202A, 0x5000}, > + {0x202C, 0x0253}, > + {0x202E, 0x0AD1}, > + {0x2030, 0x2360}, > + {0x2032, 0x0009}, > + {0x2034, 0x5020}, > + {0x2036, 0x000B}, > + {0x2038, 0x0002}, > + {0x203A, 0x0044}, > + {0x203C, 0x0016}, > + {0x203E, 0x1792}, > + {0x2040, 0x7002}, > + {0x2042, 0x154F}, > + {0x2044, 0x00D5}, > + {0x2046, 0x000B}, > + {0x2048, 0x0019}, > + {0x204A, 0x1698}, > + {0x204C, 0x000E}, > + {0x204E, 0x099A}, > + {0x2050, 0x0058}, > + {0x2052, 0x7000}, > + {0x2054, 0x1799}, > + {0x2056, 0x0310}, > + {0x2058, 0x03C3}, > + {0x205A, 0x004C}, > + {0x205C, 0x064A}, > + {0x205E, 0x0001}, > + {0x2060, 0x0007}, > + {0x2062, 0x0BC7}, > + {0x2064, 0x0055}, > + {0x2066, 0x7000}, > + {0x2068, 0x1550}, > + {0x206A, 0x158A}, > + {0x206C, 0x0004}, > + {0x206E, 0x1488}, > + {0x2070, 0x7010}, > + {0x2072, 0x1508}, > + {0x2074, 0x0004}, > + {0x2076, 0x0016}, > + {0x2078, 0x03D5}, > + {0x207A, 0x0055}, > + {0x207C, 0x08CA}, > + {0x207E, 0x2019}, > + {0x2080, 0x0007}, > + {0x2082, 0x7057}, > + {0x2084, 0x0FC7}, > + {0x2086, 0x5041}, > + {0x2088, 0x12C8}, > + {0x208A, 0x5060}, > + {0x208C, 0x5080}, > + {0x208E, 0x2084}, > + {0x2090, 0x12C8}, > + {0x2092, 0x7800}, > + {0x2094, 0x0802}, > + {0x2096, 0x040F}, > + {0x2098, 0x1007}, > + {0x209A, 0x0803}, > + {0x209C, 0x080B}, > + {0x209E, 0x3803}, > + {0x20A0, 0x0807}, > + {0x20A2, 0x0404}, > + {0x20A4, 0x0400}, > + {0x20A6, 0xFFFF}, > + {0x20A8, 0xF0B2}, > + {0x20AA, 0xFFEF}, > + {0x20AC, 0x0A84}, > + {0x20AE, 0x1292}, > + {0x20B0, 0xC02E}, > + {0x20B2, 0x4130}, > + {0x23FE, 0xC056}, > + {0x3232, 0xFC0C}, > + {0x3236, 0xFC22}, > + {0x3248, 0xFCA8}, > + {0x326A, 0x8302}, > + {0x326C, 0x830A}, > + {0x326E, 0x0000}, > + {0x32CA, 0xFC28}, > + {0x32CC, 0xC3BC}, > + {0x32CE, 0xC34C}, > + {0x32D0, 0xC35A}, > + {0x32D2, 0xC368}, > + {0x32D4, 0xC376}, > + {0x32D6, 0xC3C2}, > + {0x32D8, 0xC3E6}, > + {0x32DA, 0x0003}, > + {0x32DC, 0x0003}, > + {0x32DE, 0x00C7}, > + {0x32E0, 0x0031}, > + {0x32E2, 0x0031}, > + {0x32E4, 0x0031}, > + {0x32E6, 0xFC28}, > + {0x32E8, 0xC3BC}, > + {0x32EA, 0xC384}, > + {0x32EC, 0xC392}, > + {0x32EE, 0xC3A0}, > + {0x32F0, 0xC3AE}, > + {0x32F2, 0xC3C4}, > + {0x32F4, 0xC3E6}, > + {0x32F6, 0x0003}, > + {0x32F8, 0x0003}, > + {0x32FA, 0x00C7}, > + {0x32FC, 0x0031}, > + {0x32FE, 0x0031}, > + {0x3300, 0x0031}, > + {0x3302, 0x82CA}, > + {0x3304, 0xC164}, > + {0x3306, 0x82E6}, > + {0x3308, 0xC19C}, > + {0x330A, 0x001F}, > + {0x330C, 0x001A}, > + {0x330E, 0x0034}, > + {0x3310, 0x0000}, > + {0x3312, 0x0000}, > + {0x3314, 0xFC94}, > + {0x3316, 0xC3D8}, > + /* regs above are unknown */ > + {HI846_REG_MODE_SELECT, 0x0000}, > + {HI846_REG_UNKNOWN_0E04, 0x0012}, > + {HI846_REG_Y_ODD_INC_FOBP, 0x1111}, > + {HI846_REG_Y_ODD_INC_VACT, 0x1111}, > + {HI846_REG_UNKNOWN_0022, 0x0008}, > + {HI846_REG_Y_ADDR_START_VACT_H, 0x0040}, > + {HI846_REG_UNKNOWN_0028, 0x0017}, > + {HI846_REG_Y_ADDR_END_VACT_H, 0x09CF}, > + {HI846_REG_UNKNOWN_005C, 0x2101}, > + {HI846_REG_FLL, 0x09DE}, > + {HI846_REG_LLP, 0x0ED8}, > + {HI846_REG_IMAGE_ORIENTATION, 0x0100}, > + {HI846_REG_BINNING_MODE, 0x0022}, > + {HI846_REG_HBIN_MODE, 0x0000}, > + {HI846_REG_UNKNOWN_0A24, 0x0000}, > + {HI846_REG_X_START_H, 0x0000}, > + {HI846_REG_X_OUTPUT_SIZE_H, 0x0CC0}, > + {HI846_REG_Y_OUTPUT_SIZE_H, 0x0990}, > + {HI846_REG_EXPOSURE, 0x09D8}, > + {HI846_REG_ANALOG_GAIN, 0x0000}, > + {HI846_REG_GROUPED_PARA_HOLD, 0x0000}, > + {HI846_REG_UNKNOWN_051E, 0x0000}, > + {HI846_REG_UNKNOWN_0200, 0x0400}, > + {HI846_REG_PEDESTAL_EN, 0x0C00}, > + {HI846_REG_UNKNOWN_0A0C, 0x0010}, > + {HI846_REG_UNKNOWN_0A1E, 0x0CCF}, > + {HI846_REG_UNKNOWN_0402, 0x0110}, > + {HI846_REG_UNKNOWN_0404, 0x00F4}, > + {HI846_REG_UNKNOWN_0408, 0x0000}, > + {HI846_REG_UNKNOWN_0410, 0x008D}, > + {HI846_REG_UNKNOWN_0412, 0x011A}, > + {HI846_REG_UNKNOWN_0414, 0x864C}, > + {HI846_REG_UNKNOWN_021C, 0x0003}, > + {HI846_REG_UNKNOWN_021E, 0x0235}, > + {HI846_REG_BLC_CTL0, 0x9150}, > + {HI846_REG_UNKNOWN_0C06, 0x0021}, > + {HI846_REG_UNKNOWN_0C10, 0x0040}, > + {HI846_REG_UNKNOWN_0C12, 0x0040}, > + {HI846_REG_UNKNOWN_0C14, 0x0040}, > + {HI846_REG_UNKNOWN_0C16, 0x0040}, > + {HI846_REG_FAST_STANDBY_MODE, 0x0100}, > + {HI846_REG_ISP_EN_H, 0x014A}, > + {HI846_REG_UNKNOWN_0418, 0x0000}, > + {HI846_REG_UNKNOWN_012A, 0x03B4}, > + {HI846_REG_X_ADDR_START_HACT_H, 0x0046}, > + {HI846_REG_X_ADDR_END_HACT_H, 0x0376}, > + {HI846_REG_UNKNOWN_0B02, 0xE04D}, > + {HI846_REG_UNKNOWN_0B10, 0x6821}, > + {HI846_REG_UNKNOWN_0B12, 0x0120}, > + {HI846_REG_UNKNOWN_0B14, 0x0001}, > + {HI846_REG_UNKNOWN_2008, 0x38FD}, > + {HI846_REG_UNKNOWN_326E, 0x0000}, > + {HI846_REG_UNKNOWN_0900, 0x0320}, > + {HI846_REG_MIPI_TX_OP_MODE, 0xC31A}, > + {HI846_REG_UNKNOWN_0914, 0xC109}, > + {HI846_REG_TCLK_PREPARE, 0x061A}, > + {HI846_REG_UNKNOWN_0918, 0x0306}, > + {HI846_REG_THS_ZERO, 0x0B09}, > + {HI846_REG_TCLK_POST, 0x0C07}, > + {HI846_REG_UNKNOWN_091E, 0x0A00}, > + {HI846_REG_UNKNOWN_090C, 0x042A}, > + {HI846_REG_UNKNOWN_090E, 0x006B}, > + {HI846_REG_UNKNOWN_0954, 0x0089}, > + {HI846_REG_UNKNOWN_0956, 0x0000}, > + {HI846_REG_UNKNOWN_0958, 0xCA00}, > + {HI846_REG_UNKNOWN_095A, 0x9240}, > + {HI846_REG_UNKNOWN_0F08, 0x2F04}, > + {HI846_REG_UNKNOWN_0F30, 0x001F}, > + {HI846_REG_UNKNOWN_0F36, 0x001F}, > + {HI846_REG_UNKNOWN_0F04, 0x3A00}, > + {HI846_REG_PLL_CFG_RAMP1_H, 0x025A}, > + {HI846_REG_PLL_CFG_MIPI1_H, 0x025A}, > + {HI846_REG_PLL_CFG_MIPI2_H, 0x0024}, > + {HI846_REG_UNKNOWN_006A, 0x0100}, > + {HI846_REG_TG_ENABLE, 0x0100}, > +}; > + > +static const struct hi846_reg hi846_init_4lane[] = { > + {0x2000, 0x987A}, > + {0x2002, 0x00FF}, > + {0x2004, 0x0047}, > + {0x2006, 0x3FFF}, > + {0x2008, 0x3FFF}, > + {0x200A, 0xC216}, > + {0x200C, 0x1292}, > + {0x200E, 0xC01A}, > + {0x2010, 0x403D}, > + {0x2012, 0x000E}, > + {0x2014, 0x403E}, > + {0x2016, 0x0B80}, > + {0x2018, 0x403F}, > + {0x201A, 0x82AE}, > + {0x201C, 0x1292}, > + {0x201E, 0xC00C}, > + {0x2020, 0x4130}, > + {0x2022, 0x43E2}, > + {0x2024, 0x0180}, > + {0x2026, 0x4130}, > + {0x2028, 0x7400}, > + {0x202A, 0x5000}, > + {0x202C, 0x0253}, > + {0x202E, 0x0AD1}, > + {0x2030, 0x2360}, > + {0x2032, 0x0009}, > + {0x2034, 0x5020}, > + {0x2036, 0x000B}, > + {0x2038, 0x0002}, > + {0x203A, 0x0044}, > + {0x203C, 0x0016}, > + {0x203E, 0x1792}, > + {0x2040, 0x7002}, > + {0x2042, 0x154F}, > + {0x2044, 0x00D5}, > + {0x2046, 0x000B}, > + {0x2048, 0x0019}, > + {0x204A, 0x1698}, > + {0x204C, 0x000E}, > + {0x204E, 0x099A}, > + {0x2050, 0x0058}, > + {0x2052, 0x7000}, > + {0x2054, 0x1799}, > + {0x2056, 0x0310}, > + {0x2058, 0x03C3}, > + {0x205A, 0x004C}, > + {0x205C, 0x064A}, > + {0x205E, 0x0001}, > + {0x2060, 0x0007}, > + {0x2062, 0x0BC7}, > + {0x2064, 0x0055}, > + {0x2066, 0x7000}, > + {0x2068, 0x1550}, > + {0x206A, 0x158A}, > + {0x206C, 0x0004}, > + {0x206E, 0x1488}, > + {0x2070, 0x7010}, > + {0x2072, 0x1508}, > + {0x2074, 0x0004}, > + {0x2076, 0x0016}, > + {0x2078, 0x03D5}, > + {0x207A, 0x0055}, > + {0x207C, 0x08CA}, > + {0x207E, 0x2019}, > + {0x2080, 0x0007}, > + {0x2082, 0x7057}, > + {0x2084, 0x0FC7}, > + {0x2086, 0x5041}, > + {0x2088, 0x12C8}, > + {0x208A, 0x5060}, > + {0x208C, 0x5080}, > + {0x208E, 0x2084}, > + {0x2090, 0x12C8}, > + {0x2092, 0x7800}, > + {0x2094, 0x0802}, > + {0x2096, 0x040F}, > + {0x2098, 0x1007}, > + {0x209A, 0x0803}, > + {0x209C, 0x080B}, > + {0x209E, 0x3803}, > + {0x20A0, 0x0807}, > + {0x20A2, 0x0404}, > + {0x20A4, 0x0400}, > + {0x20A6, 0xFFFF}, > + {0x20A8, 0xF0B2}, > + {0x20AA, 0xFFEF}, > + {0x20AC, 0x0A84}, > + {0x20AE, 0x1292}, > + {0x20B0, 0xC02E}, > + {0x20B2, 0x4130}, > + {0x20B4, 0xF0B2}, > + {0x20B6, 0xFFBF}, > + {0x20B8, 0x2004}, > + {0x20BA, 0x403F}, > + {0x20BC, 0x00C3}, > + {0x20BE, 0x4FE2}, > + {0x20C0, 0x8318}, > + {0x20C2, 0x43CF}, > + {0x20C4, 0x0000}, > + {0x20C6, 0x9382}, > + {0x20C8, 0xC314}, > + {0x20CA, 0x2003}, > + {0x20CC, 0x12B0}, > + {0x20CE, 0xCAB0}, > + {0x20D0, 0x4130}, > + {0x20D2, 0x12B0}, > + {0x20D4, 0xC90A}, > + {0x20D6, 0x4130}, > + {0x20D8, 0x42D2}, > + {0x20DA, 0x8318}, > + {0x20DC, 0x00C3}, > + {0x20DE, 0x9382}, > + {0x20E0, 0xC314}, > + {0x20E2, 0x2009}, > + {0x20E4, 0x120B}, > + {0x20E6, 0x120A}, > + {0x20E8, 0x1209}, > + {0x20EA, 0x1208}, > + {0x20EC, 0x1207}, > + {0x20EE, 0x1206}, > + {0x20F0, 0x4030}, > + {0x20F2, 0xC15E}, > + {0x20F4, 0x4130}, > + {0x20F6, 0x1292}, > + {0x20F8, 0xC008}, > + {0x20FA, 0x4130}, > + {0x20FC, 0x42D2}, > + {0x20FE, 0x82A1}, > + {0x2100, 0x00C2}, > + {0x2102, 0x1292}, > + {0x2104, 0xC040}, > + {0x2106, 0x4130}, > + {0x2108, 0x1292}, > + {0x210A, 0xC006}, > + {0x210C, 0x42A2}, > + {0x210E, 0x7324}, > + {0x2110, 0x9382}, > + {0x2112, 0xC314}, > + {0x2114, 0x2011}, > + {0x2116, 0x425F}, > + {0x2118, 0x82A1}, > + {0x211A, 0xF25F}, > + {0x211C, 0x00C1}, > + {0x211E, 0xF35F}, > + {0x2120, 0x2406}, > + {0x2122, 0x425F}, > + {0x2124, 0x00C0}, > + {0x2126, 0xF37F}, > + {0x2128, 0x522F}, > + {0x212A, 0x4F82}, > + {0x212C, 0x7324}, > + {0x212E, 0x425F}, > + {0x2130, 0x82D4}, > + {0x2132, 0xF35F}, > + {0x2134, 0x4FC2}, > + {0x2136, 0x01B3}, > + {0x2138, 0x93C2}, > + {0x213A, 0x829F}, > + {0x213C, 0x2421}, > + {0x213E, 0x403E}, > + {0x2140, 0xFFFE}, > + {0x2142, 0x40B2}, > + {0x2144, 0xEC78}, > + {0x2146, 0x831C}, > + {0x2148, 0x40B2}, > + {0x214A, 0xEC78}, > + {0x214C, 0x831E}, > + {0x214E, 0x40B2}, > + {0x2150, 0xEC78}, > + {0x2152, 0x8320}, > + {0x2154, 0xB3D2}, > + {0x2156, 0x008C}, > + {0x2158, 0x2405}, > + {0x215A, 0x4E0F}, > + {0x215C, 0x503F}, > + {0x215E, 0xFFD8}, > + {0x2160, 0x4F82}, > + {0x2162, 0x831C}, > + {0x2164, 0x90F2}, > + {0x2166, 0x0003}, > + {0x2168, 0x008C}, > + {0x216A, 0x2401}, > + {0x216C, 0x4130}, > + {0x216E, 0x421F}, > + {0x2170, 0x831C}, > + {0x2172, 0x5E0F}, > + {0x2174, 0x4F82}, > + {0x2176, 0x831E}, > + {0x2178, 0x5E0F}, > + {0x217A, 0x4F82}, > + {0x217C, 0x8320}, > + {0x217E, 0x3FF6}, > + {0x2180, 0x432E}, > + {0x2182, 0x3FDF}, > + {0x2184, 0x421F}, > + {0x2186, 0x7100}, > + {0x2188, 0x4F0E}, > + {0x218A, 0x503E}, > + {0x218C, 0xFFD8}, > + {0x218E, 0x4E82}, > + {0x2190, 0x7A04}, > + {0x2192, 0x421E}, > + {0x2194, 0x831C}, > + {0x2196, 0x5F0E}, > + {0x2198, 0x4E82}, > + {0x219A, 0x7A06}, > + {0x219C, 0x0B00}, > + {0x219E, 0x7304}, > + {0x21A0, 0x0050}, > + {0x21A2, 0x40B2}, > + {0x21A4, 0xD081}, > + {0x21A6, 0x0B88}, > + {0x21A8, 0x421E}, > + {0x21AA, 0x831E}, > + {0x21AC, 0x5F0E}, > + {0x21AE, 0x4E82}, > + {0x21B0, 0x7A0E}, > + {0x21B2, 0x521F}, > + {0x21B4, 0x8320}, > + {0x21B6, 0x4F82}, > + {0x21B8, 0x7A10}, > + {0x21BA, 0x0B00}, > + {0x21BC, 0x7304}, > + {0x21BE, 0x007A}, > + {0x21C0, 0x40B2}, > + {0x21C2, 0x0081}, > + {0x21C4, 0x0B88}, > + {0x21C6, 0x4392}, > + {0x21C8, 0x7A0A}, > + {0x21CA, 0x0800}, > + {0x21CC, 0x7A0C}, > + {0x21CE, 0x0B00}, > + {0x21D0, 0x7304}, > + {0x21D2, 0x022B}, > + {0x21D4, 0x40B2}, > + {0x21D6, 0xD081}, > + {0x21D8, 0x0B88}, > + {0x21DA, 0x0B00}, > + {0x21DC, 0x7304}, > + {0x21DE, 0x0255}, > + {0x21E0, 0x40B2}, > + {0x21E2, 0x0081}, > + {0x21E4, 0x0B88}, > + {0x21E6, 0x4130}, > + {0x23FE, 0xC056}, > + {0x3232, 0xFC0C}, > + {0x3236, 0xFC22}, > + {0x3238, 0xFCFC}, > + {0x323A, 0xFD84}, > + {0x323C, 0xFD08}, > + {0x3246, 0xFCD8}, > + {0x3248, 0xFCA8}, > + {0x324E, 0xFCB4}, > + {0x326A, 0x8302}, > + {0x326C, 0x830A}, > + {0x326E, 0x0000}, > + {0x32CA, 0xFC28}, > + {0x32CC, 0xC3BC}, > + {0x32CE, 0xC34C}, > + {0x32D0, 0xC35A}, > + {0x32D2, 0xC368}, > + {0x32D4, 0xC376}, > + {0x32D6, 0xC3C2}, > + {0x32D8, 0xC3E6}, > + {0x32DA, 0x0003}, > + {0x32DC, 0x0003}, > + {0x32DE, 0x00C7}, > + {0x32E0, 0x0031}, > + {0x32E2, 0x0031}, > + {0x32E4, 0x0031}, > + {0x32E6, 0xFC28}, > + {0x32E8, 0xC3BC}, > + {0x32EA, 0xC384}, > + {0x32EC, 0xC392}, > + {0x32EE, 0xC3A0}, > + {0x32F0, 0xC3AE}, > + {0x32F2, 0xC3C4}, > + {0x32F4, 0xC3E6}, > + {0x32F6, 0x0003}, > + {0x32F8, 0x0003}, > + {0x32FA, 0x00C7}, > + {0x32FC, 0x0031}, > + {0x32FE, 0x0031}, > + {0x3300, 0x0031}, > + {0x3302, 0x82CA}, > + {0x3304, 0xC164}, > + {0x3306, 0x82E6}, > + {0x3308, 0xC19C}, > + {0x330A, 0x001F}, > + {0x330C, 0x001A}, > + {0x330E, 0x0034}, > + {0x3310, 0x0000}, > + {0x3312, 0x0000}, > + {0x3314, 0xFC94}, > + {0x3316, 0xC3D8}, > + > + {0x0A00, 0x0000}, > + {0x0E04, 0x0012}, > + {0x002E, 0x1111}, > + {0x0032, 0x1111}, > + {0x0022, 0x0008}, > + {0x0026, 0x0040}, > + {0x0028, 0x0017}, > + {0x002C, 0x09CF}, > + {0x005C, 0x2101}, > + {0x0006, 0x09DE}, > + {0x0008, 0x0ED8}, > + {0x000E, 0x0100}, > + {0x000C, 0x0022}, > + {0x0A22, 0x0000}, > + {0x0A24, 0x0000}, > + {0x0804, 0x0000}, > + {0x0A12, 0x0CC0}, > + {0x0A14, 0x0990}, > + {0x0074, 0x09D8}, > + {0x0076, 0x0000}, > + {0x051E, 0x0000}, > + {0x0200, 0x0400}, > + {0x0A1A, 0x0C00}, > + {0x0A0C, 0x0010}, > + {0x0A1E, 0x0CCF}, > + {0x0402, 0x0110}, > + {0x0404, 0x00F4}, > + {0x0408, 0x0000}, > + {0x0410, 0x008D}, > + {0x0412, 0x011A}, > + {0x0414, 0x864C}, > + /* For OTP */ > + {0x021C, 0x0003}, > + {0x021E, 0x0235}, > + /* For OTP */ > + {0x0C00, 0x9950}, > + {0x0C06, 0x0021}, > + {0x0C10, 0x0040}, > + {0x0C12, 0x0040}, > + {0x0C14, 0x0040}, > + {0x0C16, 0x0040}, > + {0x0A02, 0x0100}, > + {0x0A04, 0x015A}, > + {0x0418, 0x0000}, > + {0x0128, 0x0028}, > + {0x012A, 0xFFFF}, > + {0x0120, 0x0046}, > + {0x0122, 0x0376}, > + {0x012C, 0x0020}, > + {0x012E, 0xFFFF}, > + {0x0124, 0x0040}, > + {0x0126, 0x0378}, > + {0x0746, 0x0050}, > + {0x0748, 0x01D5}, > + {0x074A, 0x022B}, > + {0x074C, 0x03B0}, > + {0x0756, 0x043F}, > + {0x0758, 0x3F1D}, > + {0x0B02, 0xE04D}, > + {0x0B10, 0x6821}, > + {0x0B12, 0x0120}, > + {0x0B14, 0x0001}, > + {0x2008, 0x38FD}, > + {0x326E, 0x0000}, > + {0x0900, 0x0300}, > + {0x0902, 0xC319}, > + {0x0914, 0xC109}, > + {0x0916, 0x061A}, > + {0x0918, 0x0407}, > + {0x091A, 0x0A0B}, > + {0x091C, 0x0E08}, > + {0x091E, 0x0A00}, > + {0x090C, 0x0427}, > + {0x090E, 0x0059}, > + {0x0954, 0x0089}, > + {0x0956, 0x0000}, > + {0x0958, 0xCA80}, > + {0x095A, 0x9240}, > + {0x0F08, 0x2F04}, > + {0x0F30, 0x001F}, > + {0x0F36, 0x001F}, > + {0x0F04, 0x3A00}, > + {0x0F32, 0x025A}, > + {0x0F38, 0x025A}, > + {0x0F2A, 0x4124}, > + {0x006A, 0x0100}, > + {0x004C, 0x0100}, > + {0x0044, 0x0001}, > +}; > + > +static const struct hi846_reg mode_640x480_config[] = { > + {HI846_REG_MODE_SELECT, 0x0000}, > + {HI846_REG_Y_ODD_INC_FOBP, 0x7711}, > + {HI846_REG_Y_ODD_INC_VACT, 0x7711}, > + {HI846_REG_Y_ADDR_START_VACT_H, 0x0148}, > + {HI846_REG_Y_ADDR_END_VACT_H, 0x08C7}, > + {HI846_REG_UNKNOWN_005C, 0x4404}, > + {HI846_REG_FLL, 0x0277}, > + {HI846_REG_LLP, 0x0ED8}, > + {HI846_REG_BINNING_MODE, 0x0322}, > + {HI846_REG_HBIN_MODE, 0x0200}, > + {HI846_REG_UNKNOWN_0A24, 0x0000}, > + {HI846_REG_X_START_H, 0x0058}, > + {HI846_REG_X_OUTPUT_SIZE_H, 0x0280}, > + {HI846_REG_Y_OUTPUT_SIZE_H, 0x01E0}, > + > + /* For OTP */ > + {HI846_REG_UNKNOWN_021C, 0x0003}, > + {HI846_REG_UNKNOWN_021E, 0x0235}, > + > + {HI846_REG_ISP_EN_H, 0x017A}, > + {HI846_REG_UNKNOWN_0418, 0x0210}, > + {HI846_REG_UNKNOWN_0B02, 0xE04D}, > + {HI846_REG_UNKNOWN_0B10, 0x7021}, > + {HI846_REG_UNKNOWN_0B12, 0x0120}, > + {HI846_REG_UNKNOWN_0B14, 0x0001}, > + {HI846_REG_UNKNOWN_2008, 0x38FD}, > + {HI846_REG_UNKNOWN_326E, 0x0000}, > +}; > + > +static const struct hi846_reg mode_640x480_mipi_2lane[] = { > + {HI846_REG_UNKNOWN_0900, 0x0300}, > + {HI846_REG_MIPI_TX_OP_MODE, 0x4319}, > + {HI846_REG_UNKNOWN_0914, 0xC105}, > + {HI846_REG_TCLK_PREPARE, 0x030C}, > + {HI846_REG_UNKNOWN_0918, 0x0304}, > + {HI846_REG_THS_ZERO, 0x0708}, > + {HI846_REG_TCLK_POST, 0x0B04}, > + {HI846_REG_UNKNOWN_091E, 0x0500}, > + {HI846_REG_UNKNOWN_090C, 0x0208}, > + {HI846_REG_UNKNOWN_090E, 0x009A}, > + {HI846_REG_UNKNOWN_0954, 0x0089}, > + {HI846_REG_UNKNOWN_0956, 0x0000}, > + {HI846_REG_UNKNOWN_0958, 0xCA80}, > + {HI846_REG_UNKNOWN_095A, 0x9240}, > + {HI846_REG_PLL_CFG_MIPI2_H, 0x4924}, > + {HI846_REG_TG_ENABLE, 0x0100}, > +}; > + > +static const struct hi846_reg mode_1280x720_config[] = { > + {HI846_REG_MODE_SELECT, 0x0000}, > + {HI846_REG_Y_ODD_INC_FOBP, 0x3311}, > + {HI846_REG_Y_ODD_INC_VACT, 0x3311}, > + {HI846_REG_Y_ADDR_START_VACT_H, 0x0238}, > + {HI846_REG_Y_ADDR_END_VACT_H, 0x07D7}, > + {HI846_REG_UNKNOWN_005C, 0x4202}, > + {HI846_REG_FLL, 0x034A}, > + {HI846_REG_LLP, 0x0ED8}, > + {HI846_REG_BINNING_MODE, 0x0122}, > + {HI846_REG_HBIN_MODE, 0x0100}, > + {HI846_REG_UNKNOWN_0A24, 0x0000}, > + {HI846_REG_X_START_H, 0x00B0}, > + {HI846_REG_X_OUTPUT_SIZE_H, 0x0500}, > + {HI846_REG_Y_OUTPUT_SIZE_H, 0x02D0}, > + {HI846_REG_EXPOSURE, 0x0344}, > + > + /* For OTP */ > + {HI846_REG_UNKNOWN_021C, 0x0003}, > + {HI846_REG_UNKNOWN_021E, 0x0235}, > + > + {HI846_REG_ISP_EN_H, 0x017A}, > + {HI846_REG_UNKNOWN_0418, 0x0410}, > + {HI846_REG_UNKNOWN_0B02, 0xE04D}, > + {HI846_REG_UNKNOWN_0B10, 0x6C21}, > + {HI846_REG_UNKNOWN_0B12, 0x0120}, > + {HI846_REG_UNKNOWN_0B14, 0x0005}, > + {HI846_REG_UNKNOWN_2008, 0x38FD}, > + {HI846_REG_UNKNOWN_326E, 0x0000}, > +}; > + > +static const struct hi846_reg mode_1280x720_mipi_2lane[] = { > + {HI846_REG_UNKNOWN_0900, 0x0300}, > + {HI846_REG_MIPI_TX_OP_MODE, 0x4319}, > + {HI846_REG_UNKNOWN_0914, 0xC109}, > + {HI846_REG_TCLK_PREPARE, 0x061A}, > + {HI846_REG_UNKNOWN_0918, 0x0407}, > + {HI846_REG_THS_ZERO, 0x0A0B}, > + {HI846_REG_TCLK_POST, 0x0E08}, > + {HI846_REG_UNKNOWN_091E, 0x0A00}, > + {HI846_REG_UNKNOWN_090C, 0x0427}, > + {HI846_REG_UNKNOWN_090E, 0x0145}, > + {HI846_REG_UNKNOWN_0954, 0x0089}, > + {HI846_REG_UNKNOWN_0956, 0x0000}, > + {HI846_REG_UNKNOWN_0958, 0xCA80}, > + {HI846_REG_UNKNOWN_095A, 0x9240}, > + {HI846_REG_PLL_CFG_MIPI2_H, 0x4124}, > + {HI846_REG_TG_ENABLE, 0x0100}, > +}; > + > +static const struct hi846_reg mode_1280x720_mipi_4lane[] = { > + /* 360Mbps */ > + {HI846_REG_UNKNOWN_0900, 0x0300}, > + {HI846_REG_MIPI_TX_OP_MODE, 0xC319}, > + {HI846_REG_UNKNOWN_0914, 0xC105}, > + {HI846_REG_TCLK_PREPARE, 0x030C}, > + {HI846_REG_UNKNOWN_0918, 0x0304}, > + {HI846_REG_THS_ZERO, 0x0708}, > + {HI846_REG_TCLK_POST, 0x0B04}, > + {HI846_REG_UNKNOWN_091E, 0x0500}, > + {HI846_REG_UNKNOWN_090C, 0x0208}, > + {HI846_REG_UNKNOWN_090E, 0x008A}, > + {HI846_REG_UNKNOWN_0954, 0x0089}, > + {HI846_REG_UNKNOWN_0956, 0x0000}, > + {HI846_REG_UNKNOWN_0958, 0xCA80}, > + {HI846_REG_UNKNOWN_095A, 0x9240}, > + {HI846_REG_PLL_CFG_MIPI2_H, 0x4924}, > + {HI846_REG_TG_ENABLE, 0x0100}, > +}; > + > +static const struct hi846_reg mode_1632x1224_config[] = { > + {HI846_REG_MODE_SELECT, 0x0000}, > + {HI846_REG_Y_ODD_INC_FOBP, 0x3311}, > + {HI846_REG_Y_ODD_INC_VACT, 0x3311}, > + {HI846_REG_Y_ADDR_START_VACT_H, 0x0040}, > + {HI846_REG_Y_ADDR_END_VACT_H, 0x09CF}, > + {HI846_REG_UNKNOWN_005C, 0x4202}, > + {HI846_REG_FLL, 0x09DE}, > + {HI846_REG_LLP, 0x0ED8}, > + {HI846_REG_BINNING_MODE, 0x0122}, > + {HI846_REG_HBIN_MODE, 0x0100}, > + {HI846_REG_UNKNOWN_0A24, 0x0000}, > + {HI846_REG_X_START_H, 0x0000}, > + {HI846_REG_X_OUTPUT_SIZE_H, 0x0660}, > + {HI846_REG_Y_OUTPUT_SIZE_H, 0x04C8}, > + {HI846_REG_EXPOSURE, 0x09D8}, > + {HI846_REG_ISP_EN_H, 0x017A}, > + > + /* For OTP */ > + {HI846_REG_UNKNOWN_021C, 0x0003}, > + {HI846_REG_UNKNOWN_021E, 0x0235}, > + > + {HI846_REG_UNKNOWN_0418, 0x0000}, > + {HI846_REG_UNKNOWN_0B02, 0xE04D}, > + {HI846_REG_UNKNOWN_0B10, 0x6C21}, > + {HI846_REG_UNKNOWN_0B12, 0x0120}, > + {HI846_REG_UNKNOWN_0B14, 0x0005}, > + {HI846_REG_UNKNOWN_2008, 0x38FD}, > + {HI846_REG_UNKNOWN_326E, 0x0000}, > +}; > + > +static const struct hi846_reg mode_1632x1224_mipi_2lane[] = { > + {HI846_REG_UNKNOWN_0900, 0x0300}, > + {HI846_REG_MIPI_TX_OP_MODE, 0x4319}, > + {HI846_REG_UNKNOWN_0914, 0xC109}, > + {HI846_REG_TCLK_PREPARE, 0x061A}, > + {HI846_REG_UNKNOWN_0918, 0x0407}, > + {HI846_REG_THS_ZERO, 0x0A0B}, > + {HI846_REG_TCLK_POST, 0x0E08}, > + {HI846_REG_UNKNOWN_091E, 0x0A00}, > + {HI846_REG_UNKNOWN_090C, 0x0427}, > + {HI846_REG_UNKNOWN_090E, 0x0069}, > + {HI846_REG_UNKNOWN_0954, 0x0089}, > + {HI846_REG_UNKNOWN_0956, 0x0000}, > + {HI846_REG_UNKNOWN_0958, 0xCA80}, > + {HI846_REG_UNKNOWN_095A, 0x9240}, > + {HI846_REG_PLL_CFG_MIPI2_H, 0x4124}, > + {HI846_REG_TG_ENABLE, 0x0100}, > +}; > + > +static const struct hi846_reg mode_1632x1224_mipi_4lane[] = { > + {HI846_REG_UNKNOWN_0900, 0x0300}, > + {HI846_REG_MIPI_TX_OP_MODE, 0xC319}, > + {HI846_REG_UNKNOWN_0914, 0xC105}, > + {HI846_REG_TCLK_PREPARE, 0x030C}, > + {HI846_REG_UNKNOWN_0918, 0x0304}, > + {HI846_REG_THS_ZERO, 0x0708}, > + {HI846_REG_TCLK_POST, 0x0B04}, > + {HI846_REG_UNKNOWN_091E, 0x0500}, > + {HI846_REG_UNKNOWN_090C, 0x0208}, > + {HI846_REG_UNKNOWN_090E, 0x001C}, > + {HI846_REG_UNKNOWN_0954, 0x0089}, > + {HI846_REG_UNKNOWN_0956, 0x0000}, > + {HI846_REG_UNKNOWN_0958, 0xCA80}, > + {HI846_REG_UNKNOWN_095A, 0x9240}, > + {HI846_REG_PLL_CFG_MIPI2_H, 0x4924}, > + {HI846_REG_TG_ENABLE, 0x0100}, > +}; > + > +static const char * const hi846_test_pattern_menu[] = { > + "Disabled", > + "Solid Colour", > + "100% Colour Bars", > + "Fade To Grey Colour Bars", > + "PN9", > + "Gradient Horizontal", > + "Gradient Vertical", > + "Check Board", > + "Slant Pattern", > + "Resolution Pattern", > +}; > + > +#define FREQ_INDEX_640 0 > +#define FREQ_INDEX_1280 1 > +static const s64 hi846_link_freqs[] = { > + [FREQ_INDEX_640] = 80000000, > + [FREQ_INDEX_1280] = 200000000, > +}; > + > +static const struct hi846_reg_list hi846_init_regs_list_2lane = { > + .num_of_regs = ARRAY_SIZE(hi846_init_2lane), > + .regs = hi846_init_2lane, > +}; > + > +static const struct hi846_reg_list hi846_init_regs_list_4lane = { > + .num_of_regs = ARRAY_SIZE(hi846_init_4lane), > + .regs = hi846_init_4lane, > +}; > + > +static const struct hi846_mode supported_modes[] = { > + { > + .width = 640, > + .height = 480, > + .link_freq_index = FREQ_INDEX_640, > + .fps = 120, > + .frame_len = 631, > + .llp = HI846_LINE_LENGTH, > + .reg_list_config = { > + .num_of_regs = ARRAY_SIZE(mode_640x480_config), > + .regs = mode_640x480_config, > + }, > + .reg_list_2lane = { > + .num_of_regs = ARRAY_SIZE(mode_640x480_mipi_2lane), > + .regs = mode_640x480_mipi_2lane, > + }, > + }, > + { > + .width = 1280, > + .height = 720, > + .link_freq_index = FREQ_INDEX_1280, > + .fps = 90, > + .frame_len = 842, > + .llp = HI846_LINE_LENGTH, > + .reg_list_config = { > + .num_of_regs = ARRAY_SIZE(mode_1280x720_config), > + .regs = mode_1280x720_config, > + }, > + .reg_list_2lane = { > + .num_of_regs = ARRAY_SIZE(mode_1280x720_mipi_2lane), > + .regs = mode_1280x720_mipi_2lane, > + }, > + .reg_list_4lane = { > + .num_of_regs = ARRAY_SIZE(mode_1280x720_mipi_4lane), > + .regs = mode_1280x720_mipi_4lane, > + }, > + }, > + { > + .width = 1632, > + .height = 1224, > + .link_freq_index = FREQ_INDEX_1280, > + .fps = 30, > + .frame_len = 2526, > + .llp = HI846_LINE_LENGTH, > + .reg_list_config = { > + .num_of_regs = ARRAY_SIZE(mode_1632x1224_config), > + .regs = mode_1632x1224_config, > + }, > + .reg_list_2lane = { > + .num_of_regs = ARRAY_SIZE(mode_1632x1224_mipi_2lane), > + .regs = mode_1632x1224_mipi_2lane, > + }, > + .reg_list_4lane = { > + .num_of_regs = ARRAY_SIZE(mode_1632x1224_mipi_4lane), > + .regs = mode_1632x1224_mipi_4lane, > + }, > + } > +}; > + > +struct hi846_gpio { > + int gpio; > + int level; > +}; Please use the gpiod_* API, it will handle the level automatically for you. > + > +struct hi846_datafmt { > + u32 code; > + enum v4l2_colorspace colorspace; > +}; > + > +struct hi846 { > + struct hi846_gpio rst_gpio; > + struct regulator *vdd1_regulator; > + struct regulator *vdd_regulator; > + struct clk *clock; > + struct hi846_datafmt *fmt; > + struct v4l2_subdev sd; > + struct media_pad pad; > + struct v4l2_ctrl_handler ctrl_handler; > + u8 nr_lanes; > + > + struct v4l2_ctrl *link_freq; > + struct v4l2_ctrl *pixel_rate; > + struct v4l2_ctrl *vblank; > + struct v4l2_ctrl *hblank; > + struct v4l2_ctrl *exposure; > + > + const struct hi846_mode *cur_mode; > + struct mutex mutex; > + bool streaming; > +}; > + > +static struct hi846_datafmt hi846_colour_fmts[] = { This should be const. > + {HI846_MEDIA_BUS_FORMAT, V4L2_COLORSPACE_RAW}, We usually add a space after { and before }. > +}; > + > +static struct hi846_datafmt *hi846_find_datafmt(u32 code) > +{ > + int i; > + > + for (i = 0; i < ARRAY_SIZE(hi846_colour_fmts); i++) > + if (hi846_colour_fmts[i].code == code) > + return hi846_colour_fmts + i; return &hi846_colour_fmts[i]; would be more customary. There are other similar constructs below. > + > + return NULL; > +} > + > +static inline u8 hi846_get_link_freq_index(struct hi846 *hi846) > +{ > + return hi846->cur_mode->link_freq_index; > +} > + > +static s64 hi846_get_link_freq(struct hi846 *hi846) > +{ > + u8 index = hi846_get_link_freq_index(hi846); > + > + return *(hi846_link_freqs + index); Here for instance. > +} > + > +static u64 hi846_calc_pixel_rate(struct hi846 *hi846) > +{ > + s64 link_freq = hi846_get_link_freq(hi846); > + u64 pixel_rate = link_freq * 2 * hi846->nr_lanes; > + > + do_div(pixel_rate, HI846_RGB_DEPTH); > + > + return pixel_rate; > +} > + > +static int hi846_read_reg(struct hi846 *hi846, u16 reg, u8 *val) > +{ > + struct i2c_client *client = v4l2_get_subdevdata(&hi846->sd); > + struct i2c_msg msgs[2]; > + u8 addr_buf[2]; > + u8 data_buf[1] = {0}; > + int ret; > + > + put_unaligned_be16(reg, addr_buf); > + msgs[0].addr = client->addr; > + msgs[0].flags = 0; > + msgs[0].len = sizeof(addr_buf); > + msgs[0].buf = addr_buf; > + msgs[1].addr = client->addr; > + msgs[1].flags = I2C_M_RD; > + msgs[1].len = 1; > + msgs[1].buf = &data_buf[0]; > + > + ret = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs)); > + if (ret != ARRAY_SIZE(msgs)) { > + dev_err(&client->dev, "i2c read error: %d\n", ret); > + return -EIO; > + } > + > + *val = data_buf[0]; > + > + return 0; > +} > + > +static int hi846_write_reg_16(struct hi846 *hi846, u16 reg, u16 val) > +{ > + struct i2c_client *client = v4l2_get_subdevdata(&hi846->sd); > + u8 buf[6]; > + > + put_unaligned_be16(reg, buf); > + put_unaligned_be32(val << 8 * 2, buf + 2); > + if (i2c_master_send(client, buf, 4) != 4) > + return -EIO; > + > + return 0; > +} > + > +static int hi846_write_reg_list(struct hi846 *hi846, > + const struct hi846_reg_list *r_list) > +{ > + struct i2c_client *client = v4l2_get_subdevdata(&hi846->sd); > + unsigned int i; > + int ret; > + > + for (i = 0; i < r_list->num_of_regs; i++) { > + ret = hi846_write_reg_16(hi846, r_list->regs[i].address, > + r_list->regs[i].val); > + if (ret) { > + dev_err_ratelimited(&client->dev, > + "failed to write reg 0x%4.4x. error = %d", > + r_list->regs[i].address, ret); > + return ret; > + } > + } > + > + return 0; > +} > + > +static int hi846_write_reg(struct hi846 *hi846, u16 reg, u8 val) > +{ > + struct i2c_client *client = v4l2_get_subdevdata(&hi846->sd); > + u8 buf[3] = { reg >> 8, reg & 0xff, val }; > + int ret; > + > + struct i2c_msg msg[] = { > + { .addr = client->addr, .flags = 0, > + .len = ARRAY_SIZE(buf), .buf = buf }, > + }; > + > + ret = i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg)); > + if (ret != ARRAY_SIZE(msg)) { > + dev_err(&client->dev, "i2c write error\n"); > + return -EIO; > + } > + > + return 0; > +} > + > +static int hi846_update_digital_gain(struct hi846 *hi846, u16 d_gain) > +{ > + int ret; > + > + ret = hi846_write_reg_16(hi846, HI846_REG_MWB_GR_GAIN_H, d_gain); > + if (ret) > + return ret; Let's simplify error checks by passing an error status pointer to the write function. You can see how that can be implemented at https://git.linuxtv.org/pinchartl/media.git/tree/drivers/media/i2c/mt9m114.c?h=mt9m114&id=73181111a72ec7171b5c4f84ff3f304ad9a591e6#n681. The code in this function would then become int ret = 0; hi846_write_reg_16(hi846, HI846_REG_MWB_GR_GAIN_H, d_gain, &ret); hi846_write_reg_16(hi846, HI846_REG_MWB_GB_GAIN_H, d_gain, &ret); hi846_write_reg_16(hi846, HI846_REG_MWB_R_GAIN_H, d_gain, &ret); hi846_write_reg_16(hi846, HI846_REG_MWB_B_GAIN_H, d_gain, &ret); return ret; I'd also recommend, given that you have a mix of 8-bit and 16-bit registers, to use the same mechanism as in the mt9m114 driver to simplify writes, with the register macro encoding both the address and the size. > + > + ret = hi846_write_reg_16(hi846, HI846_REG_MWB_GB_GAIN_H, d_gain); > + if (ret) > + return ret; > + > + ret = hi846_write_reg_16(hi846, HI846_REG_MWB_R_GAIN_H, d_gain); > + if (ret) > + return ret; > + > + return hi846_write_reg_16(hi846, HI846_REG_MWB_B_GAIN_H, d_gain); > +} > + > +static int hi846_test_pattern(struct hi846 *hi846, u32 pattern) > +{ > + int ret; > + u8 val; > + > + if (pattern) { > + ret = hi846_read_reg(hi846, HI846_REG_ISP, &val); > + if (ret) > + return ret; > + > + ret = hi846_write_reg(hi846, HI846_REG_ISP, > + val | HI846_REG_ISP_TPG_EN); > + if (ret) > + return ret; > + } > + > + return hi846_write_reg(hi846, HI846_REG_TEST_PATTERN, pattern); > +} > + > +static int hi846_set_ctrl(struct v4l2_ctrl *ctrl) > +{ > + struct hi846 *hi846 = container_of(ctrl->handler, > + struct hi846, ctrl_handler); > + struct i2c_client *client = v4l2_get_subdevdata(&hi846->sd); > + s64 exposure_max; > + int ret = 0; > + u32 shutter, frame_len; > + > + if (!pm_runtime_get_if_in_use(&client->dev)) > + goto out; > + > + /* Propagate change of current control to all related controls */ > + if (ctrl->id == V4L2_CID_VBLANK) { > + /* Update max exposure while meeting expected vblanking */ > + exposure_max = hi846->cur_mode->height + ctrl->val - > + HI846_EXPOSURE_MAX_MARGIN; > + __v4l2_ctrl_modify_range(hi846->exposure, > + hi846->exposure->minimum, > + exposure_max, hi846->exposure->step, > + exposure_max); > + } > + > + switch (ctrl->id) { > + case V4L2_CID_ANALOGUE_GAIN: > + ret = hi846_write_reg(hi846, HI846_REG_ANALOG_GAIN, ctrl->val); > + break; > + > + case V4L2_CID_DIGITAL_GAIN: > + ret = hi846_update_digital_gain(hi846, ctrl->val); > + break; > + > + case V4L2_CID_EXPOSURE: > + shutter = ctrl->val; > + frame_len = hi846->cur_mode->frame_len; > + > + if (shutter > frame_len - 6) { /* margin */ > + frame_len = shutter + 6; > + if (frame_len > 0xffff) { /* max frame len */ > + frame_len = 0xffff; > + } > + } > + > + if (shutter < 6) > + shutter = 6; > + if (shutter > (0xffff - 6)) > + shutter = 0xffff - 6; > + > + ret = hi846_write_reg_16(hi846, HI846_REG_FLL, > + frame_len); > + ret = hi846_write_reg_16(hi846, HI846_REG_EXPOSURE, > + shutter); > + break; > + > + case V4L2_CID_VBLANK: > + /* Update FLL that meets expected vertical blanking */ > + ret = hi846_write_reg_16(hi846, HI846_REG_FLL, > + hi846->cur_mode->height + ctrl->val); > + break; > + case V4L2_CID_TEST_PATTERN: > + ret = hi846_test_pattern(hi846, ctrl->val); > + break; > + > + default: > + ret = -EINVAL; > + break; > + } > + > + pm_runtime_put(&client->dev); > +out: > + return ret; > +} > + > +static const struct v4l2_ctrl_ops hi846_ctrl_ops = { > + .s_ctrl = hi846_set_ctrl, > +}; > + > +static int hi846_init_controls(struct hi846 *hi846) > +{ > + struct v4l2_ctrl_handler *ctrl_hdlr; > + s64 exposure_max, h_blank; > + int ret; > + struct i2c_client *client = v4l2_get_subdevdata(&hi846->sd); > + > + ctrl_hdlr = &hi846->ctrl_handler; > + ret = v4l2_ctrl_handler_init(ctrl_hdlr, 8); > + if (ret) > + return ret; > + > + ctrl_hdlr->lock = &hi846->mutex; > + > + hi846->link_freq = v4l2_ctrl_new_int_menu(ctrl_hdlr, &hi846_ctrl_ops, > + V4L2_CID_LINK_FREQ, > + ARRAY_SIZE(hi846_link_freqs) - 1, > + 0, hi846_link_freqs); > + if (hi846->link_freq) > + hi846->link_freq->flags |= V4L2_CTRL_FLAG_READ_ONLY; > + > + hi846->pixel_rate = v4l2_ctrl_new_std > + (ctrl_hdlr, &hi846_ctrl_ops, > + V4L2_CID_PIXEL_RATE, 0, > + hi846_calc_pixel_rate(hi846), > + 1, > + hi846_calc_pixel_rate(hi846)); > + hi846->vblank = v4l2_ctrl_new_std(ctrl_hdlr, &hi846_ctrl_ops, > + V4L2_CID_VBLANK, > + hi846->cur_mode->frame_len - > + hi846->cur_mode->height, > + HI846_FLL_MAX - > + hi846->cur_mode->height, 1, > + hi846->cur_mode->frame_len - > + hi846->cur_mode->height); > + > + h_blank = hi846->cur_mode->llp - hi846->cur_mode->width; > + > + hi846->hblank = v4l2_ctrl_new_std(ctrl_hdlr, &hi846_ctrl_ops, > + V4L2_CID_HBLANK, h_blank, h_blank, 1, > + h_blank); > + if (hi846->hblank) > + hi846->hblank->flags |= V4L2_CTRL_FLAG_READ_ONLY; > + > + v4l2_ctrl_new_std(ctrl_hdlr, &hi846_ctrl_ops, V4L2_CID_ANALOGUE_GAIN, > + HI846_ANAL_GAIN_MIN, HI846_ANAL_GAIN_MAX, > + HI846_ANAL_GAIN_STEP, HI846_ANAL_GAIN_MIN); > + v4l2_ctrl_new_std(ctrl_hdlr, &hi846_ctrl_ops, V4L2_CID_DIGITAL_GAIN, > + HI846_DGTL_GAIN_MIN, HI846_DGTL_GAIN_MAX, > + HI846_DGTL_GAIN_STEP, HI846_DGTL_GAIN_DEFAULT); > + exposure_max = hi846->cur_mode->frame_len - HI846_EXPOSURE_MAX_MARGIN; > + hi846->exposure = v4l2_ctrl_new_std(ctrl_hdlr, &hi846_ctrl_ops, > + V4L2_CID_EXPOSURE, > + HI846_EXPOSURE_MIN, exposure_max, > + HI846_EXPOSURE_STEP, > + exposure_max); > + v4l2_ctrl_new_std_menu_items(ctrl_hdlr, &hi846_ctrl_ops, > + V4L2_CID_TEST_PATTERN, > + ARRAY_SIZE(hi846_test_pattern_menu) - 1, > + 0, 0, hi846_test_pattern_menu); > + if (ctrl_hdlr->error) { > + dev_err(&client->dev, "v4l ctrl handler error: %d\n", > + ctrl_hdlr->error); > + return ctrl_hdlr->error; > + } > + > + hi846->sd.ctrl_handler = ctrl_hdlr; > + > + return 0; > +} > + > +static int hi846_set_video_mode(struct hi846 *hi846, int fps) > +{ > + struct i2c_client *client = v4l2_get_subdevdata(&hi846->sd); > + int frame_length; > + int ret; > + int dummy_lines; > + s64 link_freq = hi846_get_link_freq(hi846); > + > + dev_dbg(&client->dev, "%s: link freq: %lld\n", __func__, > + hi846_get_link_freq(hi846)); > + > + frame_length = do_div(link_freq, do_div(fps, HI846_LINE_LENGTH)); > + dummy_lines = (frame_length > hi846->cur_mode->frame_len) ? > + (frame_length - hi846->cur_mode->frame_len) : 0; > + > + frame_length = hi846->cur_mode->frame_len + dummy_lines; > + > + dev_dbg(&client->dev, "%s: frame length calculated: %d\n", __func__, > + frame_length); > + > + ret = hi846_write_reg_16(hi846, HI846_REG_FLL, frame_length & 0xFFFF); > + ret = hi846_write_reg_16(hi846, HI846_REG_LLP, HI846_LINE_LENGTH & 0xFFFF); > + > + return ret; > +} > + > +static int hi846_start_streaming(struct hi846 *hi846) > +{ > + struct i2c_client *client = v4l2_get_subdevdata(&hi846->sd); > + int ret = 0; > + u8 val; > + > + if (hi846->nr_lanes == 2) > + ret = hi846_write_reg_list(hi846, &hi846_init_regs_list_2lane); > + else > + ret = hi846_write_reg_list(hi846, &hi846_init_regs_list_4lane); > + if (ret) { > + dev_err(&client->dev, "failed to set plls: %d\n", ret); > + return ret; > + } > + > + ret = hi846_write_reg_list(hi846, &hi846->cur_mode->reg_list_config); > + if (ret) { > + dev_err(&client->dev, "failed to set mode: %d\n", ret); > + return ret; > + } > + > + if (hi846->nr_lanes == 2) { > + if (!&hi846->cur_mode->reg_list_2lane) { > + dev_err(&client->dev, "2 lanes unsupported for this mode\n"); > + return -EINVAL; > + } > + ret = hi846_write_reg_list(hi846, &hi846->cur_mode->reg_list_2lane); > + } else { > + if (!&hi846->cur_mode->reg_list_4lane) { > + dev_err(&client->dev, "4 lanes unsupported for this mode\n"); > + return -EINVAL; > + } > + ret = hi846_write_reg_list(hi846, &hi846->cur_mode->reg_list_4lane); > + } > + if (ret) { > + dev_err(&client->dev, "failed to set mipi mode: %d\n", ret); > + return ret; > + } > + > + hi846_set_video_mode(hi846, hi846->cur_mode->fps); > + > + ret = __v4l2_ctrl_handler_setup(hi846->sd.ctrl_handler); > + if (ret) > + return ret; > + > + /* > + * Reading 0x0034 is purely done for debugging reasons: It is not > + * documented in the DS but only mentioned once: > + * "If 0x0034[2] bit is disabled , Visible pixel width and height is 0." > + * So even though that sounds like we won't see anything, we don't > + * know more about this, so in that case only inform the user but do > + * nothing more. > + */ > + ret = hi846_read_reg(hi846, 0x0034, &val); > + if (ret) > + return ret; > + if (!(val & BIT(2))) > + dev_info(&client->dev, "visible pixel width and height is 0\n"); > + > + ret = hi846_write_reg(hi846, HI846_REG_MODE_SELECT, > + HI846_MODE_STREAMING); > + if (ret) { > + dev_err(&client->dev, "failed to start stream"); > + return ret; > + } > + > + hi846->streaming = 1; > + > + dev_dbg(&client->dev, "%s: started streaming successfully\n", __func__); > + > + return ret; > +} > + > +static void hi846_stop_streaming(struct hi846 *hi846) > +{ > + struct i2c_client *client = v4l2_get_subdevdata(&hi846->sd); > + > + if (hi846_write_reg(hi846, HI846_REG_MODE_SELECT, HI846_MODE_STANDBY)) > + dev_err(&client->dev, "failed to stop stream"); > + > + hi846->streaming = 0; > +} > + > +static int hi846_set_stream(struct v4l2_subdev *sd, int enable) > +{ > + struct hi846 *hi846 = to_hi846(sd); > + struct i2c_client *client = v4l2_get_subdevdata(sd); > + int ret = 0; > + > + if (hi846->streaming == enable) > + return 0; > + > + mutex_lock(&hi846->mutex); > + > + if (enable) { > + ret = pm_runtime_get_sync(&client->dev); > + if (ret < 0) { > + pm_runtime_put_noidle(&client->dev); > + goto out; > + } > + > + ret = hi846_start_streaming(hi846); > + if (ret) { > + enable = 0; > + hi846_stop_streaming(hi846); > + pm_runtime_put(&client->dev); > + } > + } else { > + hi846_stop_streaming(hi846); > + pm_runtime_put(&client->dev); > + } > + > +out: > + mutex_unlock(&hi846->mutex); > + > + return ret; > +} > + > +static int hi846_regulator_enable(struct hi846 *hi846) > +{ > + int ret = 0; > + > + ret = regulator_enable(hi846->vdd_regulator); > + if (ret) > + return ret; > + > + return regulator_enable(hi846->vdd1_regulator); If this fails, vdd should be disabled. You can use the bulk regulator API to handle this. > +} > + > +static void hi846_regulator_disable(struct hi846 *hi846) > +{ > + if (regulator_is_enabled(hi846->vdd1_regulator)) > + regulator_disable(hi846->vdd1_regulator); Regulator enable/disable calls always need to be balanced, checking if the regulator is enabled before disabling it is most often not correct. > + > + if (regulator_is_enabled(hi846->vdd_regulator)) > + regulator_disable(hi846->vdd_regulator); > +} > + > +static int __maybe_unused hi846_suspend(struct device *dev) > +{ > + struct i2c_client *client = to_i2c_client(dev); > + struct v4l2_subdev *sd = i2c_get_clientdata(client); > + struct hi846 *hi846 = to_hi846(sd); > + > + if (hi846->streaming) > + hi846_stop_streaming(hi846); > + > + if (!IS_ERR(hi846->clock)) Can this happen ? > + clk_disable_unprepare(hi846->clock); > + > + hi846_regulator_disable(hi846); > + > + return 0; > +} > + > +static int __maybe_unused hi846_resume(struct device *dev) > +{ > + struct i2c_client *client = to_i2c_client(dev); > + struct v4l2_subdev *sd = i2c_get_clientdata(client); > + struct hi846 *hi846 = to_hi846(sd); > + int ret; > + > + ret = hi846_regulator_enable(hi846); > + if (ret) { > + dev_err(dev, "enable regulator failed: %d\n", ret); > + return ret; > + } > + > + ret = clk_prepare_enable(hi846->clock); > + if (ret < 0) { > + dev_err(dev, "enable clk failed: %d\n", ret); > + goto error_regulator; > + } > + > + msleep(100); > + > + if (hi846->streaming) { > + ret = hi846_start_streaming(hi846); > + if (ret) { > + dev_err(dev, "%s: start streaming failed: %d\n", > + __func__, ret); > + goto error; > + } > + } > + > + return 0; > + > +error: > + clk_disable_unprepare(hi846->clock); > + > +error_regulator: > + hi846_regulator_disable(hi846); > + > + return ret; > +} > + > +static int hi846_set_format(struct v4l2_subdev *sd, > + struct v4l2_subdev_pad_config *cfg, > + struct v4l2_subdev_format *format) > +{ > + struct hi846 *hi846 = to_hi846(sd); > + struct v4l2_mbus_framefmt *mf = &format->format; > + struct i2c_client *client = v4l2_get_subdevdata(sd); > + struct hi846_datafmt *fmt = hi846_find_datafmt(mf->code); > + u32 tgt_fps; > + s32 vblank_def, h_blank; > + > + if (!fmt) { > + mf->code = hi846_colour_fmts[0].code; > + mf->colorspace = hi846_colour_fmts[0].colorspace; > + fmt = &hi846_colour_fmts[0]; > + } > + > + if (format->which == V4L2_SUBDEV_FORMAT_TRY) { > + *v4l2_subdev_get_try_format(sd, cfg, format->pad) = *mf; > + return 0; > + } > + > + mutex_lock(&hi846->mutex); > + > + if (hi846->streaming) { > + mutex_unlock(&hi846->mutex); > + return -EBUSY; > + } > + > + hi846->fmt = fmt; > + > + hi846->cur_mode = v4l2_find_nearest_size(supported_modes, > + ARRAY_SIZE(supported_modes), width, > + height, mf->width, > + mf->height); > + dev_dbg(&client->dev, "%s: found mode: %dx%d\n", __func__, > + hi846->cur_mode->width, hi846->cur_mode->height); > + > + tgt_fps = hi846->cur_mode->fps; > + dev_dbg(&client->dev, "%s: target fps: %d\n", __func__, tgt_fps); > + > + mf->width = hi846->cur_mode->width; > + mf->height = hi846->cur_mode->height; > + mf->code = HI846_MEDIA_BUS_FORMAT; > + mf->field = V4L2_FIELD_NONE; > + > + __v4l2_ctrl_s_ctrl(hi846->link_freq, hi846_get_link_freq_index(hi846)); > + __v4l2_ctrl_s_ctrl_int64(hi846->pixel_rate, > + hi846_calc_pixel_rate(hi846)); > + > + /* Update limits and set FPS to default */ > + vblank_def = hi846->cur_mode->frame_len - hi846->cur_mode->height; > + __v4l2_ctrl_modify_range(hi846->vblank, > + hi846->cur_mode->frame_len - hi846->cur_mode->height, > + HI846_FLL_MAX - hi846->cur_mode->height, 1, > + vblank_def); > + __v4l2_ctrl_s_ctrl(hi846->vblank, vblank_def); > + > + h_blank = hi846->cur_mode->llp - hi846->cur_mode->width; > + > + __v4l2_ctrl_modify_range(hi846->hblank, h_blank, h_blank, 1, > + h_blank); > + > + dev_dbg(&client->dev, "Set fmt w=%d h=%d code=0x%x colorspace=0x%x\n", > + mf->width, mf->height, > + fmt->code, fmt->colorspace); > + > + mutex_unlock(&hi846->mutex); > + > + return 0; > +} > + > +static int hi846_get_format(struct v4l2_subdev *sd, > + struct v4l2_subdev_pad_config *cfg, > + struct v4l2_subdev_format *format) > +{ > + struct hi846 *hi846 = to_hi846(sd); > + struct v4l2_mbus_framefmt *mf = &format->format; > + struct i2c_client *client = v4l2_get_subdevdata(sd); > + > + if (format->pad) > + return -EINVAL; > + > + if (format->which == V4L2_SUBDEV_FORMAT_TRY) { > + format->format = *v4l2_subdev_get_try_format(&hi846->sd, > + cfg, > + format->pad); > + return 0; > + } > + > + mutex_lock(&hi846->mutex); > + mf->code = HI846_MEDIA_BUS_FORMAT; > + mf->colorspace = V4L2_COLORSPACE_RAW; > + mf->field = V4L2_FIELD_NONE; > + mf->width = hi846->cur_mode->width; > + mf->height = hi846->cur_mode->height; > + mutex_unlock(&hi846->mutex); > + dev_dbg(&client->dev, > + "Get format w=%d h=%d code=0x%x colorspace=0x%x\n", > + mf->width, mf->height, mf->code, mf->colorspace); > + > + return 0; > +} > + > +static int hi846_enum_mbus_code(struct v4l2_subdev *sd, > + struct v4l2_subdev_pad_config *cfg, > + struct v4l2_subdev_mbus_code_enum *code) > +{ > + if (code->pad || code->index > 0) > + return -EINVAL; > + > + code->code = HI846_MEDIA_BUS_FORMAT; > + > + return 0; > +} > + > +static int hi846_enum_frame_size(struct v4l2_subdev *sd, > + struct v4l2_subdev_pad_config *cfg, > + struct v4l2_subdev_frame_size_enum *fse) > +{ > + struct i2c_client *client = v4l2_get_subdevdata(sd); > + > + if (fse->pad || fse->index >= ARRAY_SIZE(supported_modes)) > + return -EINVAL; > + > + if (fse->code != HI846_MEDIA_BUS_FORMAT) { > + dev_err(&client->dev, "frame size enum not matching\n"); > + return -EINVAL; > + } > + > + fse->min_width = supported_modes[fse->index].width; > + fse->max_width = supported_modes[fse->index].width; > + fse->min_height = supported_modes[fse->index].height; > + fse->max_height = supported_modes[fse->index].height; > + > + dev_dbg(&client->dev, "%s: max width: %d max height: %d\n", __func__, > + fse->max_width, fse->max_height); > + > + return 0; > +} > + > +static int hi846_s_power(struct v4l2_subdev *sd, int on) > +{ > + struct hi846 *hi846 = to_hi846(sd); > + struct i2c_client *client = v4l2_get_subdevdata(sd); > + struct device *dev = &client->dev; > + int ret = 0; > + > + mutex_lock(&hi846->mutex); > + if (on) { > + ret = hi846_resume(dev); > + if (ret) > + goto out; > + } else { > + ret = hi846_suspend(dev); > + if (ret) > + goto out; > + } > +out: > + mutex_unlock(&hi846->mutex); > + return ret; > +} > + > +static int hi846_open(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh) > +{ > + struct hi846 *hi846 = to_hi846(sd); > + struct v4l2_mbus_framefmt *mf; > + > + mf = v4l2_subdev_get_try_format(sd, fh->pad, 0); > + > + mutex_lock(&hi846->mutex); > + mf->code = HI846_MEDIA_BUS_FORMAT; > + mf->colorspace = V4L2_COLORSPACE_RAW; > + mf->field = V4L2_FIELD_NONE; > + mf->width = hi846->cur_mode->width; > + mf->height = hi846->cur_mode->height; > + mutex_unlock(&hi846->mutex); > + > + return 0; > +} Initialization of the try format is better performed in the .init_cfg() function, you can then drop .open(). > + > +static const struct v4l2_subdev_video_ops hi846_video_ops = { > + .s_stream = hi846_set_stream, > +}; > + > +static const struct v4l2_subdev_pad_ops hi846_pad_ops = { > + .enum_frame_size = hi846_enum_frame_size, > + .enum_mbus_code = hi846_enum_mbus_code, > + .set_fmt = hi846_set_format, > + .get_fmt = hi846_get_format, Please also implement .get_selection() to allow querying the CROP, CROP_BOUNDS and CROP_DEFAULT. The first one can depend on the current mode, the last two should be fixed. > +}; > + > +static struct v4l2_subdev_core_ops hi846_core_ops = { This should be const. > + .s_power = hi846_s_power, .s_power() is deprecated, power should be controlled at .s_stream() time with runtime PM, and the driver should use the runtime PM autoidle feature. > + .log_status = v4l2_ctrl_subdev_log_status, > +}; > + > +static const struct v4l2_subdev_ops hi846_subdev_ops = { > + .core = &hi846_core_ops, > + .video = &hi846_video_ops, > + .pad = &hi846_pad_ops, > +}; > + > +static const struct media_entity_operations hi846_subdev_entity_ops = { > + .link_validate = v4l2_subdev_link_validate, > +}; > + > +static const struct v4l2_subdev_internal_ops hi846_internal_ops = { > + .open = hi846_open, > +}; > + > +static void hi846_rst_gpio_assert(struct hi846 *hi846, bool on) > +{ > + struct hi846_gpio *gpio = &hi846->rst_gpio; > + > + if (gpio == NULL) > + return; > + > + if (on) > + gpio_set_value(gpio->gpio, gpio->level); > + else > + gpio_set_value(gpio->gpio, !gpio->level); > +} > + > +static int hi846_parse_gpio(struct hi846_gpio *gpio, struct device *dev) > +{ > + struct device_node *node = dev->of_node; > + enum of_gpio_flags flags; > + int ret; > + > + ret = of_get_named_gpio_flags(node, "reset-gpios", 0, &flags); > + if (ret < 0) { > + dev_err(dev, "no reset-gpios provided: %d\n", ret); > + return ret; > + } > + gpio->gpio = ret; > + gpio->level = !(flags & OF_GPIO_ACTIVE_LOW); > + > + return 0; > +} > + > +static int hi846_identify_module(struct hi846 *hi846) > +{ > + struct i2c_client *client = v4l2_get_subdevdata(&hi846->sd); > + int ret; > + u8 hi, lo; > + > + ret = hi846_read_reg(hi846, HI846_REG_CHIP_ID_L, &lo); > + if (ret) > + return ret; > + > + if (lo != HI846_CHIP_ID_L) { > + dev_err(&client->dev, "wrong chip id low byte: %x", lo); > + return -ENXIO; > + } > + > + ret = hi846_read_reg(hi846, HI846_REG_CHIP_ID_H, &hi); > + if (ret) > + return ret; > + > + if (hi != HI846_CHIP_ID_H) { > + dev_err(&client->dev, "wrong chip id high byte: %x", hi); > + return -ENXIO; > + } > + > + dev_info(&client->dev, "chip id %02X %02X using %d mipi lanes\n", hi, lo, > + hi846->nr_lanes); > + > + return 0; > +} > + > +static int hi846_check_hwcfg(struct device *dev, u8 *lanes) > +{ > + struct fwnode_handle *ep; > + struct fwnode_handle *fwnode = dev_fwnode(dev); > + struct v4l2_fwnode_endpoint bus_cfg = { > + .bus_type = V4L2_MBUS_CSI2_DPHY > + }; > + int ret = 0; No need to initialize ret to 0. > + > + if (!fwnode) > + return -ENXIO; Can this happen ? > + > + ep = fwnode_graph_get_next_endpoint(fwnode, NULL); > + if (!ep) An error message would be nice. > + return -ENXIO; > + > + ret = v4l2_fwnode_endpoint_alloc_parse(ep, &bus_cfg); > + fwnode_handle_put(ep); > + if (ret) Same here. > + return ret; > + > + if (bus_cfg.bus.mipi_csi2.num_data_lanes != 2 && > + bus_cfg.bus.mipi_csi2.num_data_lanes != 4) { > + dev_err(dev, "number of CSI2 data lanes %d is not supported", > + bus_cfg.bus.mipi_csi2.num_data_lanes); > + ret = -EINVAL; > + goto check_hwcfg_error; > + } > + > + *lanes = bus_cfg.bus.mipi_csi2.num_data_lanes; > + > +check_hwcfg_error: > + v4l2_fwnode_endpoint_free(&bus_cfg); > + > + return ret; > +} > + > +static int hi846_remove(struct i2c_client *client) > +{ > + struct v4l2_subdev *sd = i2c_get_clientdata(client); > + struct hi846 *hi846 = to_hi846(sd); > + > + v4l2_async_unregister_subdev(sd); > + media_entity_cleanup(&sd->entity); > + v4l2_ctrl_handler_free(sd->ctrl_handler); > + > + pm_runtime_disable(&client->dev); > + if (!pm_runtime_status_suspended(&client->dev)) > + hi846_suspend(&client->dev); > + pm_runtime_set_suspended(&client->dev); > + > + mutex_destroy(&hi846->mutex); > + > + return 0; > +} It's customary to place remove() after probe() (but not required). > + > +static int hi846_probe(struct i2c_client *client) > +{ > + struct hi846 *hi846; > + int ret; > + u8 lanes; > + > + ret = hi846_check_hwcfg(&client->dev, &lanes); > + if (ret) { > + dev_err(&client->dev, "failed to check HW configuration: %d", > + ret); > + return ret; > + } I'd move this after the devm_kzalloc(). The function will then be able to set hi846->nr_lanes directly. I'd also rename it to hi846_parse_dt() or something similar. > + > + hi846 = devm_kzalloc(&client->dev, sizeof(*hi846), GFP_KERNEL); > + if (!hi846) > + return -ENOMEM; > + > + hi846->nr_lanes = lanes; > + > + v4l2_i2c_subdev_init(&hi846->sd, client, &hi846_subdev_ops); Let's acquire all the resources (GPIOs, clocks and regulators) before dealing with subdev initialization. > + > + ret = hi846_parse_gpio(&hi846->rst_gpio, &client->dev); > + if (ret < 0) { > + dev_err(&client->dev, "parse gpio failed: %d\n", ret); > + return ret; > + } > + > + hi846->vdd_regulator = devm_regulator_get(&client->dev, "vdd"); > + if (IS_ERR(hi846->vdd_regulator)) > + dev_warn(&client->dev, "cannot get voltage regulator\n"); > + > + hi846->vdd1_regulator = devm_regulator_get(&client->dev, "vdd1"); Not documented in the DT bindings, and there's no VDD1 supply in the datasheet. > + if (IS_ERR(hi846->vdd1_regulator)) > + dev_warn(&client->dev, "cannot get voltage regulator\n"); > + > + ret = hi846_regulator_enable(hi846); > + if (ret) { > + dev_err(&client->dev, "regulator enable failed: %d\n", ret); > + return ret; > + } And let's move the regualtor enable with the clock prepare below. I'd actually move the regulator enable, clock enable and reset handling to a separate hi846_power_on() function, as you need to do the same here and in hi846_resume(). Same for power off. > + > + hi846->clock = devm_clk_get(hi846->sd.dev, "mclk"); > + if (IS_ERR(hi846->clock)) { > + dev_err(&client->dev, "get clk failed\n"); > + ret = -EPROBE_DEFER; > + goto probe_error_regulator; > + } > + > + ret = clk_prepare_enable(hi846->clock); > + if (ret < 0) > + goto probe_error_regulator; > + > + msleep(100); I see corresponding delay in the datasheet. There's however a 2400 MCLK cycles delay required after deassering RESETB before issuing the first I2C transaction. > + > + hi846_rst_gpio_assert(hi846, true); > + > + ret = hi846_identify_module(hi846); > + if (ret) { > + dev_err(&client->dev, "failed to find sensor: %d", ret); > + goto probe_error_regulator; > + } > + > + mutex_init(&hi846->mutex); > + > + hi846->cur_mode = &supported_modes[0]; > + ret = hi846_init_controls(hi846); > + if (ret) { > + dev_err(&client->dev, "failed to init controls: %d", ret); > + goto probe_error_v4l2_ctrl_handler_free; > + } > + > + hi846->sd.internal_ops = &hi846_internal_ops; > + hi846->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE; > + hi846->sd.entity.ops = &hi846_subdev_entity_ops; > + hi846->sd.entity.function = MEDIA_ENT_F_CAM_SENSOR; > + hi846->pad.flags = MEDIA_PAD_FL_SOURCE; > + ret = media_entity_pads_init(&hi846->sd.entity, 1, &hi846->pad); > + if (ret) { > + dev_err(&client->dev, "failed to init entity pads: %d", ret); > + goto probe_error_v4l2_ctrl_handler_free; > + } > + > + ret = v4l2_async_register_subdev_sensor(&hi846->sd); > + if (ret < 0) { > + dev_err(&client->dev, "failed to register V4L2 subdev: %d", > + ret); > + goto probe_error_media_entity_cleanup; > + } > + > + pm_runtime_set_active(&client->dev); > + pm_runtime_enable(&client->dev); > + pm_runtime_idle(&client->dev); > + > + return 0; > + > +probe_error_media_entity_cleanup: > + media_entity_cleanup(&hi846->sd.entity); > + > +probe_error_v4l2_ctrl_handler_free: > + v4l2_ctrl_handler_free(hi846->sd.ctrl_handler); > + mutex_destroy(&hi846->mutex); > + > +probe_error_regulator: > + hi846_regulator_disable(hi846); > + > + return ret; > +} > + > +static UNIVERSAL_DEV_PM_OPS(hi846_pm_ops, hi846_suspend, hi846_resume, NULL); > + > +static const struct of_device_id hi846_of_match[] = { > + { .compatible = "hynix,hi846", }, > + {}, > +}; > +MODULE_DEVICE_TABLE(of, hi846_of_match); > + > +static struct i2c_driver hi846_i2c_driver = { > + .driver = { > + .name = "hi846", > + .pm = &hi846_pm_ops, > + .of_match_table = of_match_ptr(hi846_of_match), > + }, > + .probe_new = hi846_probe, > + .remove = hi846_remove, > +}; > + > +module_i2c_driver(hi846_i2c_driver); > + > +MODULE_AUTHOR("Angus Ainslie <angus@akkea.ca>"); > +MODULE_AUTHOR("Martin Kepplinger <martin.kepplinger@puri.sm>"); > +MODULE_DESCRIPTION("Hynix HI846 sensor driver"); > +MODULE_LICENSE("GPL v2"); -- Regards, Laurent Pinchart ^ permalink raw reply [flat|nested] 14+ messages in thread
* Re: [PATCH v3 3/5] media: i2c: add driver for the SK Hynix Hi-846 8M pixel camera 2021-06-01 0:14 ` Laurent Pinchart @ 2021-06-02 12:00 ` Martin Kepplinger 2021-06-02 17:57 ` Laurent Pinchart 0 siblings, 1 reply; 14+ messages in thread From: Martin Kepplinger @ 2021-06-02 12:00 UTC (permalink / raw) To: Laurent Pinchart Cc: pavel, krzysztof.kozlowski, mchehab, paul.kocialkowski, robh, shawnx.tu, devicetree, kernel, linux-kernel, linux-media, phone-devel Am Dienstag, dem 01.06.2021 um 03:14 +0300 schrieb Laurent Pinchart: > Hi Martin, > > Thank you for the patch. > > On Mon, May 31, 2021 at 02:07:35PM +0200, Martin Kepplinger wrote: > > The SK Hynix Hi-846 is a 1/4" 8M Pixel CMOS Image Sensor. It > > supports > > usual features like I2C control, CSI-2 for frame data, > > digital/analog > > gain control or test patterns. > > > > This driver supports the 640x480, 1280x720 and 1632x1224 resolution > > modes. It supports runtime PM in order not to draw any unnecessary > > power. > > > > The part is also called YACG4D0C9SHC and a datasheet can be found > > at > > https://product.skhynix.com/products/cis/cis.go > > > > The large sets of partly undocumented register values are for > > example > > found when searching for the hi846_mipi_raw_Sensor.c Android > > driver. > > A common story, unfortunately :-S > > I've done an initial review, I'll likely have more comments on v4, > but > you should have quite a few things to address already :-) > > > Signed-off-by: Martin Kepplinger <martin.kepplinger@puri.sm> > > --- > > MAINTAINERS | 6 + > > drivers/media/i2c/Kconfig | 13 + > > drivers/media/i2c/Makefile | 1 + > > drivers/media/i2c/hi846.c | 2138 > > ++++++++++++++++++++++++++++++++++++ > > 4 files changed, 2158 insertions(+) > > create mode 100644 drivers/media/i2c/hi846.c > > > > diff --git a/MAINTAINERS b/MAINTAINERS > > index 503fd21901f1..27283b289123 100644 > > --- a/MAINTAINERS > > +++ b/MAINTAINERS > > @@ -8432,6 +8432,12 @@ S: Maintained > > T: git git://linuxtv.org/media_tree.git > > F: drivers/media/i2c/hi556.c > > > > +HYNIX HI846 SENSOR DRIVER > > +M: Martin Kepplinger <martin.kepplinger@puri.sm> > > +L: linux-media@vger.kernel.org > > +S: Maintained > > +F: drivers/media/i2c/hi846.c > > + > > Hyper-V/Azure CORE AND DRIVERS > > M: "K. Y. Srinivasan" <kys@microsoft.com> > > M: Haiyang Zhang <haiyangz@microsoft.com> > > diff --git a/drivers/media/i2c/Kconfig b/drivers/media/i2c/Kconfig > > index 462c0e059754..f8cf5bf8eb68 100644 > > --- a/drivers/media/i2c/Kconfig > > +++ b/drivers/media/i2c/Kconfig > > @@ -738,6 +738,19 @@ config VIDEO_HI556 > > To compile this driver as a module, choose M here: the > > module will be called hi556. > > > > +config VIDEO_HI846 > > + tristate "Hynix Hi-846 sensor support" > > + depends on I2C && VIDEO_V4L2 > > + select MEDIA_CONTROLLER > > + select VIDEO_V4L2_SUBDEV_API > > + select V4L2_FWNODE > > + help > > + This is a Video4Linux2 sensor driver for the Hynix > > + Hi-846 camera. > > + > > + To compile this driver as a module, choose M here: the > > + module will be called hi846. > > + > > config VIDEO_IMX214 > > tristate "Sony IMX214 sensor support" > > depends on GPIOLIB && I2C && VIDEO_V4L2 > > diff --git a/drivers/media/i2c/Makefile > > b/drivers/media/i2c/Makefile > > index 0c067beca066..1194c5e6708b 100644 > > --- a/drivers/media/i2c/Makefile > > +++ b/drivers/media/i2c/Makefile > > @@ -116,6 +116,7 @@ obj-$(CONFIG_VIDEO_ML86V7667) += > > ml86v7667.o > > obj-$(CONFIG_VIDEO_OV2659) += ov2659.o > > obj-$(CONFIG_VIDEO_TC358743) += tc358743.o > > obj-$(CONFIG_VIDEO_HI556) += hi556.o > > +obj-$(CONFIG_VIDEO_HI846) += hi846.o > > obj-$(CONFIG_VIDEO_IMX214) += imx214.o > > obj-$(CONFIG_VIDEO_IMX219) += imx219.o > > obj-$(CONFIG_VIDEO_IMX258) += imx258.o > > diff --git a/drivers/media/i2c/hi846.c b/drivers/media/i2c/hi846.c > > new file mode 100644 > > index 000000000000..80d1ccb15123 > > --- /dev/null > > +++ b/drivers/media/i2c/hi846.c > > @@ -0,0 +1,2138 @@ > > +// SPDX-License-Identifier: GPL-2.0 > > +// Copyright (c) 2021 Purism SPC > > + > > +#include <asm/unaligned.h> > > +#include <linux/clk.h> > > +#include <linux/delay.h> > > +#include <linux/gpio.h> > > +#include <linux/i2c.h> > > +#include <linux/module.h> > > +#include <linux/of_gpio.h> > > +#include <linux/of_graph.h> > > +#include <linux/regulator/consumer.h> > > +#include <linux/pm_runtime.h> > > +#include <linux/pm.h> > > Please keep the headers sorted alphabetically. > > > +#include <media/v4l2-ctrls.h> > > +#include <media/v4l2-device.h> > > +#include <media/v4l2-fwnode.h> > > + > > + > > +#define HI846_MEDIA_BUS_FORMAT MEDIA_BUS_FMT_SGBRG10_1X10 > > +#define HI846_RGB_DEPTH 10 > > +#define DEFAULT_FPS 30 > > Not used. > > > + > > +/* Frame length lines / Vertical timings */ > > +#define HI846_REG_FLL 0x0006 > > +#define HI846_FLL_MAX 0xffff > > + > > +/* Horizontal timing */ > > +#define HI846_REG_LLP 0x0008 > > +#define HI846_LINE_LENGTH 3800 > > + > > +#define HI846_REG_BINNING_MODE 0x000c > > + > > +#define HI846_REG_IMAGE_ORIENTATION 0x000e > > + > > +#define HI846_REG_UNKNOWN_0022 0x0022 > > + > > +#define HI846_REG_Y_ADDR_START_VACT_H 0x0026 > > +#define HI846_REG_Y_ADDR_START_VACT_L 0x0027 > > +#define HI846_REG_UNKNOWN_0028 0x0028 > > + > > +#define HI846_REG_Y_ADDR_END_VACT_H 0x002c > > +#define HI846_REG_Y_ADDR_END_VACT_L 0x002d > > + > > +#define HI846_REG_Y_ODD_INC_FOBP 0x002e > > +#define HI846_REG_Y_EVEN_INC_FOBP 0x002f > > + > > +#define HI846_REG_Y_ODD_INC_VACT 0x0032 > > +#define HI846_REG_Y_EVEN_INC_VACT 0x0033 > > + > > +#define HI846_REG_GROUPED_PARA_HOLD 0x0046 > > + > > +#define HI846_REG_TG_ENABLE 0x004c > > + > > +#define HI846_REG_UNKNOWN_005C 0x005c > > + > > +#define HI846_REG_UNKNOWN_006A 0x006a > > + > > +/* Long exposure time. Actually, exposure is a 20 bit value that > > The kernel coding style starts multi-line comments with '/*' on a > line > of its own. > > > + * includes the lower 4 bits of 0x0073 too. only 16 bit are used > > + * right now > > + */ > > +#define HI846_REG_EXPOSURE 0x0074 > > +#define HI846_EXPOSURE_MIN 6 > > +#define HI846_EXPOSURE_MAX_MARGIN 2 > > +#define HI846_EXPOSURE_STEP 1 > > + > > +/* Analog gain controls from sensor */ > > +#define HI846_REG_ANALOG_GAIN 0x0077 > > +#define HI846_ANAL_GAIN_MIN 0 > > +#define HI846_ANAL_GAIN_MAX 240 > > +#define HI846_ANAL_GAIN_STEP 8 > > + > > +/* Digital gain controls from sensor */ > > +#define HI846_REG_MWB_GR_GAIN_H 0x0078 > > +#define HI846_REG_MWB_GR_GAIN_L 0x0079 > > +#define HI846_REG_MWB_GB_GAIN_H 0x007a > > +#define HI846_REG_MWB_GB_GAIN_L 0x007b > > +#define HI846_REG_MWB_R_GAIN_H 0x007c > > +#define HI846_REG_MWB_R_GAIN_L 0x007d > > +#define HI846_REG_MWB_B_GAIN_H 0x007e > > +#define HI846_REG_MWB_B_GAIN_L 0x007f > > +#define HI846_DGTL_GAIN_MIN 0 > > +#define HI846_DGTL_GAIN_MAX 8191 > > +#define HI846_DGTL_GAIN_STEP 1 > > +#define HI846_DGTL_GAIN_DEFAULT 256 > > + > > +#define HI846_REG_X_ADDR_START_HACT_H 0x0120 > > +#define HI846_REG_X_ADDR_END_HACT_H 0x0122 > > + > > +#define HI846_REG_UNKNOWN_012A 0x012a > > + > > +#define HI846_REG_UNKNOWN_0200 0x0200 > > + > > +#define HI846_REG_UNKNOWN_021C 0x021c > > +#define HI846_REG_UNKNOWN_021E 0x021e > > + > > +#define HI846_REG_UNKNOWN_0402 0x0402 > > +#define HI846_REG_UNKNOWN_0404 0x0404 > > +#define HI846_REG_UNKNOWN_0408 0x0408 > > +#define HI846_REG_UNKNOWN_0410 0x0410 > > +#define HI846_REG_UNKNOWN_0412 0x0412 > > +#define HI846_REG_UNKNOWN_0414 0x0414 > > + > > +#define HI846_REG_UNKNOWN_0418 0x0418 > > + > > +#define HI846_REG_UNKNOWN_051E 0x051e > > + > > +/* Formatter */ > > +#define HI846_REG_X_START_H 0x0804 > > +#define HI846_REG_X_START_L 0x0805 > > + > > +/* MIPI */ > > +#define HI846_REG_UNKNOWN_0900 0x0900 > > +#define HI846_REG_MIPI_TX_OP_EN 0x0901 > > +#define HI846_REG_MIPI_TX_OP_MODE 0x0902 > > +#define HI846_RAW8 BIT(5) > > + > > +#define HI846_REG_UNKNOWN_090C 0x090c > > +#define HI846_REG_UNKNOWN_090E 0x090e > > + > > +#define HI846_REG_UNKNOWN_0914 0x0914 > > +#define HI846_REG_TLPX 0x0915 > > +#define HI846_REG_TCLK_PREPARE 0x0916 > > +#define HI846_REG_TCLK_ZERO 0x0917 > > +#define HI846_REG_UNKNOWN_0918 0x0918 > > +#define HI846_REG_THS_PREPARE 0x0919 > > +#define HI846_REG_THS_ZERO 0x091a > > +#define HI846_REG_THS_TRAIL 0x091b > > +#define HI846_REG_TCLK_POST 0x091c > > +#define HI846_REG_TCLK_TRAIL_MIN 0x091d > > +#define HI846_REG_UNKNOWN_091E 0x091e > > + > > +#define HI846_REG_UNKNOWN_0954 0x0954 > > +#define HI846_REG_UNKNOWN_0956 0x0956 > > +#define HI846_REG_UNKNOWN_0958 0x0958 > > +#define HI846_REG_UNKNOWN_095A 0x095a > > + > > +/* ISP Common */ > > +#define HI846_REG_MODE_SELECT 0x0a00 > > +#define HI846_MODE_STANDBY 0x00 > > +#define HI846_MODE_STREAMING 0x01 > > +#define HI846_REG_FAST_STANDBY_MODE 0x0a02 > > +#define HI846_REG_ISP_EN_H 0x0a04 > > + > > +/* Test Pattern Control */ > > +#define HI846_REG_ISP 0x0a05 > > +#define HI846_REG_ISP_TPG_EN 0x01 > > +#define HI846_REG_TEST_PATTERN 0x020a /* 1-9 */ > > + > > +#define HI846_REG_UNKNOWN_0A0C 0x0a0c > > + > > +/* Windowing */ > > +#define HI846_REG_X_OUTPUT_SIZE_H 0x0a12 > > +#define HI846_REG_X_OUTPUT_SIZE_L 0x0a13 > > +#define HI846_REG_Y_OUTPUT_SIZE_H 0x0a14 > > +#define HI846_REG_Y_OUTPUT_SIZE_L 0x0a15 > > + > > +/* ISP Common */ > > +#define HI846_REG_PEDESTAL_EN 0x0a1a > > + > > +#define HI846_REG_UNKNOWN_0A1E 0x0a1e > > + > > +/* Horizontal Binning Mode */ > > +#define HI846_REG_HBIN_MODE 0x0a22 > > + > > +#define HI846_REG_UNKNOWN_0A24 0x0a24 > > +#define HI846_REG_UNKNOWN_0B02 0x0b02 > > +#define HI846_REG_UNKNOWN_0B10 0x0b10 > > +#define HI846_REG_UNKNOWN_0B12 0x0b12 > > +#define HI846_REG_UNKNOWN_0B14 0x0b14 > > + > > +/* BLC (Black Level Calibration) */ > > +#define HI846_REG_BLC_CTL0 0x0c00 > > + > > +#define HI846_REG_UNKNOWN_0C06 0x0c06 > > +#define HI846_REG_UNKNOWN_0C10 0x0c10 > > +#define HI846_REG_UNKNOWN_0C12 0x0c12 > > +#define HI846_REG_UNKNOWN_0C14 0x0c14 > > +#define HI846_REG_UNKNOWN_0C16 0x0c16 > > + > > +#define HI846_REG_UNKNOWN_0E04 0x0e04 > > + > > +#define HI846_REG_CHIP_ID_L 0x0f16 > > +#define HI846_REG_CHIP_ID_H 0x0f17 > > +#define HI846_CHIP_ID_L 0x46 > > +#define HI846_CHIP_ID_H 0x08 > > + > > +#define HI846_REG_UNKNOWN_0F04 0x0f04 > > +#define HI846_REG_UNKNOWN_0F08 0x0f08 > > + > > +/* PLL */ > > +#define HI846_REG_PLL_CFG_MIPI2_H 0x0f2a > > +#define HI846_REG_PLL_CFG_MIPI2_L 0x0f2b > > + > > +#define HI846_REG_UNKNOWN_0F30 0x0f30 > > +#define HI846_REG_PLL_CFG_RAMP1_H 0x0f32 > > +#define HI846_REG_UNKNOWN_0F36 0x0f36 > > +#define HI846_REG_PLL_CFG_MIPI1_H 0x0f38 > > + > > +#define HI846_REG_UNKNOWN_2008 0x2008 > > +#define HI846_REG_UNKNOWN_326E 0x326e > > + > > +struct hi846_reg { > > + u16 address; > > + u16 val; > > +}; > > + > > +struct hi846_reg_list { > > + u32 num_of_regs; > > + const struct hi846_reg *regs; > > +}; > > + > > +struct hi846_mode { > > + /* Frame width in pixels */ > > + u32 width; > > + > > + /* Frame height in pixels */ > > + u32 height; > > + > > + /* Horizontal timing size */ > > + u32 llp; > > + > > + /* Link frequency needed for this resolution */ > > + u8 link_freq_index; > > + > > + u16 fps; > > + > > + /* vertical timining size */ > > + u16 frame_len; > > + > > + const struct hi846_reg_list reg_list_config; > > + const struct hi846_reg_list reg_list_2lane; > > + const struct hi846_reg_list reg_list_4lane; > > +}; > > + > > +#define to_hi846(_sd) container_of(_sd, struct hi846, sd) > > Could you replace the macro with an inline function ? It provides > additional compile-time type checks. > > > + > > +static const struct hi846_reg hi846_init_2lane[] = { > > + {HI846_REG_MODE_SELECT, 0x0000}, > > + /* regs below are unknown */ > > + {0x2000, 0x100A}, > > Lower-case for hex constants please. > > > + {0x2002, 0x00FF}, > > + {0x2004, 0x0007}, > > + {0x2006, 0x3FFF}, > > + {0x2008, 0x3FFF}, > > + {0x200A, 0xC216}, > > + {0x200C, 0x1292}, > > + {0x200E, 0xC01A}, > > + {0x2010, 0x403D}, > > + {0x2012, 0x000E}, > > + {0x2014, 0x403E}, > > + {0x2016, 0x0B80}, > > + {0x2018, 0x403F}, > > + {0x201A, 0x82AE}, > > + {0x201C, 0x1292}, > > + {0x201E, 0xC00C}, > > + {0x2020, 0x4130}, > > + {0x2022, 0x43E2}, > > + {0x2024, 0x0180}, > > + {0x2026, 0x4130}, > > + {0x2028, 0x7400}, > > + {0x202A, 0x5000}, > > + {0x202C, 0x0253}, > > + {0x202E, 0x0AD1}, > > + {0x2030, 0x2360}, > > + {0x2032, 0x0009}, > > + {0x2034, 0x5020}, > > + {0x2036, 0x000B}, > > + {0x2038, 0x0002}, > > + {0x203A, 0x0044}, > > + {0x203C, 0x0016}, > > + {0x203E, 0x1792}, > > + {0x2040, 0x7002}, > > + {0x2042, 0x154F}, > > + {0x2044, 0x00D5}, > > + {0x2046, 0x000B}, > > + {0x2048, 0x0019}, > > + {0x204A, 0x1698}, > > + {0x204C, 0x000E}, > > + {0x204E, 0x099A}, > > + {0x2050, 0x0058}, > > + {0x2052, 0x7000}, > > + {0x2054, 0x1799}, > > + {0x2056, 0x0310}, > > + {0x2058, 0x03C3}, > > + {0x205A, 0x004C}, > > + {0x205C, 0x064A}, > > + {0x205E, 0x0001}, > > + {0x2060, 0x0007}, > > + {0x2062, 0x0BC7}, > > + {0x2064, 0x0055}, > > + {0x2066, 0x7000}, > > + {0x2068, 0x1550}, > > + {0x206A, 0x158A}, > > + {0x206C, 0x0004}, > > + {0x206E, 0x1488}, > > + {0x2070, 0x7010}, > > + {0x2072, 0x1508}, > > + {0x2074, 0x0004}, > > + {0x2076, 0x0016}, > > + {0x2078, 0x03D5}, > > + {0x207A, 0x0055}, > > + {0x207C, 0x08CA}, > > + {0x207E, 0x2019}, > > + {0x2080, 0x0007}, > > + {0x2082, 0x7057}, > > + {0x2084, 0x0FC7}, > > + {0x2086, 0x5041}, > > + {0x2088, 0x12C8}, > > + {0x208A, 0x5060}, > > + {0x208C, 0x5080}, > > + {0x208E, 0x2084}, > > + {0x2090, 0x12C8}, > > + {0x2092, 0x7800}, > > + {0x2094, 0x0802}, > > + {0x2096, 0x040F}, > > + {0x2098, 0x1007}, > > + {0x209A, 0x0803}, > > + {0x209C, 0x080B}, > > + {0x209E, 0x3803}, > > + {0x20A0, 0x0807}, > > + {0x20A2, 0x0404}, > > + {0x20A4, 0x0400}, > > + {0x20A6, 0xFFFF}, > > + {0x20A8, 0xF0B2}, > > + {0x20AA, 0xFFEF}, > > + {0x20AC, 0x0A84}, > > + {0x20AE, 0x1292}, > > + {0x20B0, 0xC02E}, > > + {0x20B2, 0x4130}, > > + {0x23FE, 0xC056}, > > + {0x3232, 0xFC0C}, > > + {0x3236, 0xFC22}, > > + {0x3248, 0xFCA8}, > > + {0x326A, 0x8302}, > > + {0x326C, 0x830A}, > > + {0x326E, 0x0000}, > > + {0x32CA, 0xFC28}, > > + {0x32CC, 0xC3BC}, > > + {0x32CE, 0xC34C}, > > + {0x32D0, 0xC35A}, > > + {0x32D2, 0xC368}, > > + {0x32D4, 0xC376}, > > + {0x32D6, 0xC3C2}, > > + {0x32D8, 0xC3E6}, > > + {0x32DA, 0x0003}, > > + {0x32DC, 0x0003}, > > + {0x32DE, 0x00C7}, > > + {0x32E0, 0x0031}, > > + {0x32E2, 0x0031}, > > + {0x32E4, 0x0031}, > > + {0x32E6, 0xFC28}, > > + {0x32E8, 0xC3BC}, > > + {0x32EA, 0xC384}, > > + {0x32EC, 0xC392}, > > + {0x32EE, 0xC3A0}, > > + {0x32F0, 0xC3AE}, > > + {0x32F2, 0xC3C4}, > > + {0x32F4, 0xC3E6}, > > + {0x32F6, 0x0003}, > > + {0x32F8, 0x0003}, > > + {0x32FA, 0x00C7}, > > + {0x32FC, 0x0031}, > > + {0x32FE, 0x0031}, > > + {0x3300, 0x0031}, > > + {0x3302, 0x82CA}, > > + {0x3304, 0xC164}, > > + {0x3306, 0x82E6}, > > + {0x3308, 0xC19C}, > > + {0x330A, 0x001F}, > > + {0x330C, 0x001A}, > > + {0x330E, 0x0034}, > > + {0x3310, 0x0000}, > > + {0x3312, 0x0000}, > > + {0x3314, 0xFC94}, > > + {0x3316, 0xC3D8}, > > + /* regs above are unknown */ > > + {HI846_REG_MODE_SELECT, 0x0000}, > > + {HI846_REG_UNKNOWN_0E04, 0x0012}, > > + {HI846_REG_Y_ODD_INC_FOBP, 0x1111}, > > + {HI846_REG_Y_ODD_INC_VACT, 0x1111}, > > + {HI846_REG_UNKNOWN_0022, 0x0008}, > > + {HI846_REG_Y_ADDR_START_VACT_H, 0x0040}, > > + {HI846_REG_UNKNOWN_0028, 0x0017}, > > + {HI846_REG_Y_ADDR_END_VACT_H, 0x09CF}, > > + {HI846_REG_UNKNOWN_005C, 0x2101}, > > + {HI846_REG_FLL, 0x09DE}, > > + {HI846_REG_LLP, 0x0ED8}, > > + {HI846_REG_IMAGE_ORIENTATION, 0x0100}, > > + {HI846_REG_BINNING_MODE, 0x0022}, > > + {HI846_REG_HBIN_MODE, 0x0000}, > > + {HI846_REG_UNKNOWN_0A24, 0x0000}, > > + {HI846_REG_X_START_H, 0x0000}, > > + {HI846_REG_X_OUTPUT_SIZE_H, 0x0CC0}, > > + {HI846_REG_Y_OUTPUT_SIZE_H, 0x0990}, > > + {HI846_REG_EXPOSURE, 0x09D8}, > > + {HI846_REG_ANALOG_GAIN, 0x0000}, > > + {HI846_REG_GROUPED_PARA_HOLD, 0x0000}, > > + {HI846_REG_UNKNOWN_051E, 0x0000}, > > + {HI846_REG_UNKNOWN_0200, 0x0400}, > > + {HI846_REG_PEDESTAL_EN, 0x0C00}, > > + {HI846_REG_UNKNOWN_0A0C, 0x0010}, > > + {HI846_REG_UNKNOWN_0A1E, 0x0CCF}, > > + {HI846_REG_UNKNOWN_0402, 0x0110}, > > + {HI846_REG_UNKNOWN_0404, 0x00F4}, > > + {HI846_REG_UNKNOWN_0408, 0x0000}, > > + {HI846_REG_UNKNOWN_0410, 0x008D}, > > + {HI846_REG_UNKNOWN_0412, 0x011A}, > > + {HI846_REG_UNKNOWN_0414, 0x864C}, > > + {HI846_REG_UNKNOWN_021C, 0x0003}, > > + {HI846_REG_UNKNOWN_021E, 0x0235}, > > + {HI846_REG_BLC_CTL0, 0x9150}, > > + {HI846_REG_UNKNOWN_0C06, 0x0021}, > > + {HI846_REG_UNKNOWN_0C10, 0x0040}, > > + {HI846_REG_UNKNOWN_0C12, 0x0040}, > > + {HI846_REG_UNKNOWN_0C14, 0x0040}, > > + {HI846_REG_UNKNOWN_0C16, 0x0040}, > > + {HI846_REG_FAST_STANDBY_MODE, 0x0100}, > > + {HI846_REG_ISP_EN_H, 0x014A}, > > + {HI846_REG_UNKNOWN_0418, 0x0000}, > > + {HI846_REG_UNKNOWN_012A, 0x03B4}, > > + {HI846_REG_X_ADDR_START_HACT_H, 0x0046}, > > + {HI846_REG_X_ADDR_END_HACT_H, 0x0376}, > > + {HI846_REG_UNKNOWN_0B02, 0xE04D}, > > + {HI846_REG_UNKNOWN_0B10, 0x6821}, > > + {HI846_REG_UNKNOWN_0B12, 0x0120}, > > + {HI846_REG_UNKNOWN_0B14, 0x0001}, > > + {HI846_REG_UNKNOWN_2008, 0x38FD}, > > + {HI846_REG_UNKNOWN_326E, 0x0000}, > > + {HI846_REG_UNKNOWN_0900, 0x0320}, > > + {HI846_REG_MIPI_TX_OP_MODE, 0xC31A}, > > + {HI846_REG_UNKNOWN_0914, 0xC109}, > > + {HI846_REG_TCLK_PREPARE, 0x061A}, > > + {HI846_REG_UNKNOWN_0918, 0x0306}, > > + {HI846_REG_THS_ZERO, 0x0B09}, > > + {HI846_REG_TCLK_POST, 0x0C07}, > > + {HI846_REG_UNKNOWN_091E, 0x0A00}, > > + {HI846_REG_UNKNOWN_090C, 0x042A}, > > + {HI846_REG_UNKNOWN_090E, 0x006B}, > > + {HI846_REG_UNKNOWN_0954, 0x0089}, > > + {HI846_REG_UNKNOWN_0956, 0x0000}, > > + {HI846_REG_UNKNOWN_0958, 0xCA00}, > > + {HI846_REG_UNKNOWN_095A, 0x9240}, > > + {HI846_REG_UNKNOWN_0F08, 0x2F04}, > > + {HI846_REG_UNKNOWN_0F30, 0x001F}, > > + {HI846_REG_UNKNOWN_0F36, 0x001F}, > > + {HI846_REG_UNKNOWN_0F04, 0x3A00}, > > + {HI846_REG_PLL_CFG_RAMP1_H, 0x025A}, > > + {HI846_REG_PLL_CFG_MIPI1_H, 0x025A}, > > + {HI846_REG_PLL_CFG_MIPI2_H, 0x0024}, > > + {HI846_REG_UNKNOWN_006A, 0x0100}, > > + {HI846_REG_TG_ENABLE, 0x0100}, > > +}; > > + > > +static const struct hi846_reg hi846_init_4lane[] = { > > + {0x2000, 0x987A}, > > + {0x2002, 0x00FF}, > > + {0x2004, 0x0047}, > > + {0x2006, 0x3FFF}, > > + {0x2008, 0x3FFF}, > > + {0x200A, 0xC216}, > > + {0x200C, 0x1292}, > > + {0x200E, 0xC01A}, > > + {0x2010, 0x403D}, > > + {0x2012, 0x000E}, > > + {0x2014, 0x403E}, > > + {0x2016, 0x0B80}, > > + {0x2018, 0x403F}, > > + {0x201A, 0x82AE}, > > + {0x201C, 0x1292}, > > + {0x201E, 0xC00C}, > > + {0x2020, 0x4130}, > > + {0x2022, 0x43E2}, > > + {0x2024, 0x0180}, > > + {0x2026, 0x4130}, > > + {0x2028, 0x7400}, > > + {0x202A, 0x5000}, > > + {0x202C, 0x0253}, > > + {0x202E, 0x0AD1}, > > + {0x2030, 0x2360}, > > + {0x2032, 0x0009}, > > + {0x2034, 0x5020}, > > + {0x2036, 0x000B}, > > + {0x2038, 0x0002}, > > + {0x203A, 0x0044}, > > + {0x203C, 0x0016}, > > + {0x203E, 0x1792}, > > + {0x2040, 0x7002}, > > + {0x2042, 0x154F}, > > + {0x2044, 0x00D5}, > > + {0x2046, 0x000B}, > > + {0x2048, 0x0019}, > > + {0x204A, 0x1698}, > > + {0x204C, 0x000E}, > > + {0x204E, 0x099A}, > > + {0x2050, 0x0058}, > > + {0x2052, 0x7000}, > > + {0x2054, 0x1799}, > > + {0x2056, 0x0310}, > > + {0x2058, 0x03C3}, > > + {0x205A, 0x004C}, > > + {0x205C, 0x064A}, > > + {0x205E, 0x0001}, > > + {0x2060, 0x0007}, > > + {0x2062, 0x0BC7}, > > + {0x2064, 0x0055}, > > + {0x2066, 0x7000}, > > + {0x2068, 0x1550}, > > + {0x206A, 0x158A}, > > + {0x206C, 0x0004}, > > + {0x206E, 0x1488}, > > + {0x2070, 0x7010}, > > + {0x2072, 0x1508}, > > + {0x2074, 0x0004}, > > + {0x2076, 0x0016}, > > + {0x2078, 0x03D5}, > > + {0x207A, 0x0055}, > > + {0x207C, 0x08CA}, > > + {0x207E, 0x2019}, > > + {0x2080, 0x0007}, > > + {0x2082, 0x7057}, > > + {0x2084, 0x0FC7}, > > + {0x2086, 0x5041}, > > + {0x2088, 0x12C8}, > > + {0x208A, 0x5060}, > > + {0x208C, 0x5080}, > > + {0x208E, 0x2084}, > > + {0x2090, 0x12C8}, > > + {0x2092, 0x7800}, > > + {0x2094, 0x0802}, > > + {0x2096, 0x040F}, > > + {0x2098, 0x1007}, > > + {0x209A, 0x0803}, > > + {0x209C, 0x080B}, > > + {0x209E, 0x3803}, > > + {0x20A0, 0x0807}, > > + {0x20A2, 0x0404}, > > + {0x20A4, 0x0400}, > > + {0x20A6, 0xFFFF}, > > + {0x20A8, 0xF0B2}, > > + {0x20AA, 0xFFEF}, > > + {0x20AC, 0x0A84}, > > + {0x20AE, 0x1292}, > > + {0x20B0, 0xC02E}, > > + {0x20B2, 0x4130}, > > + {0x20B4, 0xF0B2}, > > + {0x20B6, 0xFFBF}, > > + {0x20B8, 0x2004}, > > + {0x20BA, 0x403F}, > > + {0x20BC, 0x00C3}, > > + {0x20BE, 0x4FE2}, > > + {0x20C0, 0x8318}, > > + {0x20C2, 0x43CF}, > > + {0x20C4, 0x0000}, > > + {0x20C6, 0x9382}, > > + {0x20C8, 0xC314}, > > + {0x20CA, 0x2003}, > > + {0x20CC, 0x12B0}, > > + {0x20CE, 0xCAB0}, > > + {0x20D0, 0x4130}, > > + {0x20D2, 0x12B0}, > > + {0x20D4, 0xC90A}, > > + {0x20D6, 0x4130}, > > + {0x20D8, 0x42D2}, > > + {0x20DA, 0x8318}, > > + {0x20DC, 0x00C3}, > > + {0x20DE, 0x9382}, > > + {0x20E0, 0xC314}, > > + {0x20E2, 0x2009}, > > + {0x20E4, 0x120B}, > > + {0x20E6, 0x120A}, > > + {0x20E8, 0x1209}, > > + {0x20EA, 0x1208}, > > + {0x20EC, 0x1207}, > > + {0x20EE, 0x1206}, > > + {0x20F0, 0x4030}, > > + {0x20F2, 0xC15E}, > > + {0x20F4, 0x4130}, > > + {0x20F6, 0x1292}, > > + {0x20F8, 0xC008}, > > + {0x20FA, 0x4130}, > > + {0x20FC, 0x42D2}, > > + {0x20FE, 0x82A1}, > > + {0x2100, 0x00C2}, > > + {0x2102, 0x1292}, > > + {0x2104, 0xC040}, > > + {0x2106, 0x4130}, > > + {0x2108, 0x1292}, > > + {0x210A, 0xC006}, > > + {0x210C, 0x42A2}, > > + {0x210E, 0x7324}, > > + {0x2110, 0x9382}, > > + {0x2112, 0xC314}, > > + {0x2114, 0x2011}, > > + {0x2116, 0x425F}, > > + {0x2118, 0x82A1}, > > + {0x211A, 0xF25F}, > > + {0x211C, 0x00C1}, > > + {0x211E, 0xF35F}, > > + {0x2120, 0x2406}, > > + {0x2122, 0x425F}, > > + {0x2124, 0x00C0}, > > + {0x2126, 0xF37F}, > > + {0x2128, 0x522F}, > > + {0x212A, 0x4F82}, > > + {0x212C, 0x7324}, > > + {0x212E, 0x425F}, > > + {0x2130, 0x82D4}, > > + {0x2132, 0xF35F}, > > + {0x2134, 0x4FC2}, > > + {0x2136, 0x01B3}, > > + {0x2138, 0x93C2}, > > + {0x213A, 0x829F}, > > + {0x213C, 0x2421}, > > + {0x213E, 0x403E}, > > + {0x2140, 0xFFFE}, > > + {0x2142, 0x40B2}, > > + {0x2144, 0xEC78}, > > + {0x2146, 0x831C}, > > + {0x2148, 0x40B2}, > > + {0x214A, 0xEC78}, > > + {0x214C, 0x831E}, > > + {0x214E, 0x40B2}, > > + {0x2150, 0xEC78}, > > + {0x2152, 0x8320}, > > + {0x2154, 0xB3D2}, > > + {0x2156, 0x008C}, > > + {0x2158, 0x2405}, > > + {0x215A, 0x4E0F}, > > + {0x215C, 0x503F}, > > + {0x215E, 0xFFD8}, > > + {0x2160, 0x4F82}, > > + {0x2162, 0x831C}, > > + {0x2164, 0x90F2}, > > + {0x2166, 0x0003}, > > + {0x2168, 0x008C}, > > + {0x216A, 0x2401}, > > + {0x216C, 0x4130}, > > + {0x216E, 0x421F}, > > + {0x2170, 0x831C}, > > + {0x2172, 0x5E0F}, > > + {0x2174, 0x4F82}, > > + {0x2176, 0x831E}, > > + {0x2178, 0x5E0F}, > > + {0x217A, 0x4F82}, > > + {0x217C, 0x8320}, > > + {0x217E, 0x3FF6}, > > + {0x2180, 0x432E}, > > + {0x2182, 0x3FDF}, > > + {0x2184, 0x421F}, > > + {0x2186, 0x7100}, > > + {0x2188, 0x4F0E}, > > + {0x218A, 0x503E}, > > + {0x218C, 0xFFD8}, > > + {0x218E, 0x4E82}, > > + {0x2190, 0x7A04}, > > + {0x2192, 0x421E}, > > + {0x2194, 0x831C}, > > + {0x2196, 0x5F0E}, > > + {0x2198, 0x4E82}, > > + {0x219A, 0x7A06}, > > + {0x219C, 0x0B00}, > > + {0x219E, 0x7304}, > > + {0x21A0, 0x0050}, > > + {0x21A2, 0x40B2}, > > + {0x21A4, 0xD081}, > > + {0x21A6, 0x0B88}, > > + {0x21A8, 0x421E}, > > + {0x21AA, 0x831E}, > > + {0x21AC, 0x5F0E}, > > + {0x21AE, 0x4E82}, > > + {0x21B0, 0x7A0E}, > > + {0x21B2, 0x521F}, > > + {0x21B4, 0x8320}, > > + {0x21B6, 0x4F82}, > > + {0x21B8, 0x7A10}, > > + {0x21BA, 0x0B00}, > > + {0x21BC, 0x7304}, > > + {0x21BE, 0x007A}, > > + {0x21C0, 0x40B2}, > > + {0x21C2, 0x0081}, > > + {0x21C4, 0x0B88}, > > + {0x21C6, 0x4392}, > > + {0x21C8, 0x7A0A}, > > + {0x21CA, 0x0800}, > > + {0x21CC, 0x7A0C}, > > + {0x21CE, 0x0B00}, > > + {0x21D0, 0x7304}, > > + {0x21D2, 0x022B}, > > + {0x21D4, 0x40B2}, > > + {0x21D6, 0xD081}, > > + {0x21D8, 0x0B88}, > > + {0x21DA, 0x0B00}, > > + {0x21DC, 0x7304}, > > + {0x21DE, 0x0255}, > > + {0x21E0, 0x40B2}, > > + {0x21E2, 0x0081}, > > + {0x21E4, 0x0B88}, > > + {0x21E6, 0x4130}, > > + {0x23FE, 0xC056}, > > + {0x3232, 0xFC0C}, > > + {0x3236, 0xFC22}, > > + {0x3238, 0xFCFC}, > > + {0x323A, 0xFD84}, > > + {0x323C, 0xFD08}, > > + {0x3246, 0xFCD8}, > > + {0x3248, 0xFCA8}, > > + {0x324E, 0xFCB4}, > > + {0x326A, 0x8302}, > > + {0x326C, 0x830A}, > > + {0x326E, 0x0000}, > > + {0x32CA, 0xFC28}, > > + {0x32CC, 0xC3BC}, > > + {0x32CE, 0xC34C}, > > + {0x32D0, 0xC35A}, > > + {0x32D2, 0xC368}, > > + {0x32D4, 0xC376}, > > + {0x32D6, 0xC3C2}, > > + {0x32D8, 0xC3E6}, > > + {0x32DA, 0x0003}, > > + {0x32DC, 0x0003}, > > + {0x32DE, 0x00C7}, > > + {0x32E0, 0x0031}, > > + {0x32E2, 0x0031}, > > + {0x32E4, 0x0031}, > > + {0x32E6, 0xFC28}, > > + {0x32E8, 0xC3BC}, > > + {0x32EA, 0xC384}, > > + {0x32EC, 0xC392}, > > + {0x32EE, 0xC3A0}, > > + {0x32F0, 0xC3AE}, > > + {0x32F2, 0xC3C4}, > > + {0x32F4, 0xC3E6}, > > + {0x32F6, 0x0003}, > > + {0x32F8, 0x0003}, > > + {0x32FA, 0x00C7}, > > + {0x32FC, 0x0031}, > > + {0x32FE, 0x0031}, > > + {0x3300, 0x0031}, > > + {0x3302, 0x82CA}, > > + {0x3304, 0xC164}, > > + {0x3306, 0x82E6}, > > + {0x3308, 0xC19C}, > > + {0x330A, 0x001F}, > > + {0x330C, 0x001A}, > > + {0x330E, 0x0034}, > > + {0x3310, 0x0000}, > > + {0x3312, 0x0000}, > > + {0x3314, 0xFC94}, > > + {0x3316, 0xC3D8}, > > + > > + {0x0A00, 0x0000}, > > + {0x0E04, 0x0012}, > > + {0x002E, 0x1111}, > > + {0x0032, 0x1111}, > > + {0x0022, 0x0008}, > > + {0x0026, 0x0040}, > > + {0x0028, 0x0017}, > > + {0x002C, 0x09CF}, > > + {0x005C, 0x2101}, > > + {0x0006, 0x09DE}, > > + {0x0008, 0x0ED8}, > > + {0x000E, 0x0100}, > > + {0x000C, 0x0022}, > > + {0x0A22, 0x0000}, > > + {0x0A24, 0x0000}, > > + {0x0804, 0x0000}, > > + {0x0A12, 0x0CC0}, > > + {0x0A14, 0x0990}, > > + {0x0074, 0x09D8}, > > + {0x0076, 0x0000}, > > + {0x051E, 0x0000}, > > + {0x0200, 0x0400}, > > + {0x0A1A, 0x0C00}, > > + {0x0A0C, 0x0010}, > > + {0x0A1E, 0x0CCF}, > > + {0x0402, 0x0110}, > > + {0x0404, 0x00F4}, > > + {0x0408, 0x0000}, > > + {0x0410, 0x008D}, > > + {0x0412, 0x011A}, > > + {0x0414, 0x864C}, > > + /* For OTP */ > > + {0x021C, 0x0003}, > > + {0x021E, 0x0235}, > > + /* For OTP */ > > + {0x0C00, 0x9950}, > > + {0x0C06, 0x0021}, > > + {0x0C10, 0x0040}, > > + {0x0C12, 0x0040}, > > + {0x0C14, 0x0040}, > > + {0x0C16, 0x0040}, > > + {0x0A02, 0x0100}, > > + {0x0A04, 0x015A}, > > + {0x0418, 0x0000}, > > + {0x0128, 0x0028}, > > + {0x012A, 0xFFFF}, > > + {0x0120, 0x0046}, > > + {0x0122, 0x0376}, > > + {0x012C, 0x0020}, > > + {0x012E, 0xFFFF}, > > + {0x0124, 0x0040}, > > + {0x0126, 0x0378}, > > + {0x0746, 0x0050}, > > + {0x0748, 0x01D5}, > > + {0x074A, 0x022B}, > > + {0x074C, 0x03B0}, > > + {0x0756, 0x043F}, > > + {0x0758, 0x3F1D}, > > + {0x0B02, 0xE04D}, > > + {0x0B10, 0x6821}, > > + {0x0B12, 0x0120}, > > + {0x0B14, 0x0001}, > > + {0x2008, 0x38FD}, > > + {0x326E, 0x0000}, > > + {0x0900, 0x0300}, > > + {0x0902, 0xC319}, > > + {0x0914, 0xC109}, > > + {0x0916, 0x061A}, > > + {0x0918, 0x0407}, > > + {0x091A, 0x0A0B}, > > + {0x091C, 0x0E08}, > > + {0x091E, 0x0A00}, > > + {0x090C, 0x0427}, > > + {0x090E, 0x0059}, > > + {0x0954, 0x0089}, > > + {0x0956, 0x0000}, > > + {0x0958, 0xCA80}, > > + {0x095A, 0x9240}, > > + {0x0F08, 0x2F04}, > > + {0x0F30, 0x001F}, > > + {0x0F36, 0x001F}, > > + {0x0F04, 0x3A00}, > > + {0x0F32, 0x025A}, > > + {0x0F38, 0x025A}, > > + {0x0F2A, 0x4124}, > > + {0x006A, 0x0100}, > > + {0x004C, 0x0100}, > > + {0x0044, 0x0001}, > > +}; > > + > > +static const struct hi846_reg mode_640x480_config[] = { > > + {HI846_REG_MODE_SELECT, 0x0000}, > > + {HI846_REG_Y_ODD_INC_FOBP, 0x7711}, > > + {HI846_REG_Y_ODD_INC_VACT, 0x7711}, > > + {HI846_REG_Y_ADDR_START_VACT_H, 0x0148}, > > + {HI846_REG_Y_ADDR_END_VACT_H, 0x08C7}, > > + {HI846_REG_UNKNOWN_005C, 0x4404}, > > + {HI846_REG_FLL, 0x0277}, > > + {HI846_REG_LLP, 0x0ED8}, > > + {HI846_REG_BINNING_MODE, 0x0322}, > > + {HI846_REG_HBIN_MODE, 0x0200}, > > + {HI846_REG_UNKNOWN_0A24, 0x0000}, > > + {HI846_REG_X_START_H, 0x0058}, > > + {HI846_REG_X_OUTPUT_SIZE_H, 0x0280}, > > + {HI846_REG_Y_OUTPUT_SIZE_H, 0x01E0}, > > + > > + /* For OTP */ > > + {HI846_REG_UNKNOWN_021C, 0x0003}, > > + {HI846_REG_UNKNOWN_021E, 0x0235}, > > + > > + {HI846_REG_ISP_EN_H, 0x017A}, > > + {HI846_REG_UNKNOWN_0418, 0x0210}, > > + {HI846_REG_UNKNOWN_0B02, 0xE04D}, > > + {HI846_REG_UNKNOWN_0B10, 0x7021}, > > + {HI846_REG_UNKNOWN_0B12, 0x0120}, > > + {HI846_REG_UNKNOWN_0B14, 0x0001}, > > + {HI846_REG_UNKNOWN_2008, 0x38FD}, > > + {HI846_REG_UNKNOWN_326E, 0x0000}, > > +}; > > + > > +static const struct hi846_reg mode_640x480_mipi_2lane[] = { > > + {HI846_REG_UNKNOWN_0900, 0x0300}, > > + {HI846_REG_MIPI_TX_OP_MODE, 0x4319}, > > + {HI846_REG_UNKNOWN_0914, 0xC105}, > > + {HI846_REG_TCLK_PREPARE, 0x030C}, > > + {HI846_REG_UNKNOWN_0918, 0x0304}, > > + {HI846_REG_THS_ZERO, 0x0708}, > > + {HI846_REG_TCLK_POST, 0x0B04}, > > + {HI846_REG_UNKNOWN_091E, 0x0500}, > > + {HI846_REG_UNKNOWN_090C, 0x0208}, > > + {HI846_REG_UNKNOWN_090E, 0x009A}, > > + {HI846_REG_UNKNOWN_0954, 0x0089}, > > + {HI846_REG_UNKNOWN_0956, 0x0000}, > > + {HI846_REG_UNKNOWN_0958, 0xCA80}, > > + {HI846_REG_UNKNOWN_095A, 0x9240}, > > + {HI846_REG_PLL_CFG_MIPI2_H, 0x4924}, > > + {HI846_REG_TG_ENABLE, 0x0100}, > > +}; > > + > > +static const struct hi846_reg mode_1280x720_config[] = { > > + {HI846_REG_MODE_SELECT, 0x0000}, > > + {HI846_REG_Y_ODD_INC_FOBP, 0x3311}, > > + {HI846_REG_Y_ODD_INC_VACT, 0x3311}, > > + {HI846_REG_Y_ADDR_START_VACT_H, 0x0238}, > > + {HI846_REG_Y_ADDR_END_VACT_H, 0x07D7}, > > + {HI846_REG_UNKNOWN_005C, 0x4202}, > > + {HI846_REG_FLL, 0x034A}, > > + {HI846_REG_LLP, 0x0ED8}, > > + {HI846_REG_BINNING_MODE, 0x0122}, > > + {HI846_REG_HBIN_MODE, 0x0100}, > > + {HI846_REG_UNKNOWN_0A24, 0x0000}, > > + {HI846_REG_X_START_H, 0x00B0}, > > + {HI846_REG_X_OUTPUT_SIZE_H, 0x0500}, > > + {HI846_REG_Y_OUTPUT_SIZE_H, 0x02D0}, > > + {HI846_REG_EXPOSURE, 0x0344}, > > + > > + /* For OTP */ > > + {HI846_REG_UNKNOWN_021C, 0x0003}, > > + {HI846_REG_UNKNOWN_021E, 0x0235}, > > + > > + {HI846_REG_ISP_EN_H, 0x017A}, > > + {HI846_REG_UNKNOWN_0418, 0x0410}, > > + {HI846_REG_UNKNOWN_0B02, 0xE04D}, > > + {HI846_REG_UNKNOWN_0B10, 0x6C21}, > > + {HI846_REG_UNKNOWN_0B12, 0x0120}, > > + {HI846_REG_UNKNOWN_0B14, 0x0005}, > > + {HI846_REG_UNKNOWN_2008, 0x38FD}, > > + {HI846_REG_UNKNOWN_326E, 0x0000}, > > +}; > > + > > +static const struct hi846_reg mode_1280x720_mipi_2lane[] = { > > + {HI846_REG_UNKNOWN_0900, 0x0300}, > > + {HI846_REG_MIPI_TX_OP_MODE, 0x4319}, > > + {HI846_REG_UNKNOWN_0914, 0xC109}, > > + {HI846_REG_TCLK_PREPARE, 0x061A}, > > + {HI846_REG_UNKNOWN_0918, 0x0407}, > > + {HI846_REG_THS_ZERO, 0x0A0B}, > > + {HI846_REG_TCLK_POST, 0x0E08}, > > + {HI846_REG_UNKNOWN_091E, 0x0A00}, > > + {HI846_REG_UNKNOWN_090C, 0x0427}, > > + {HI846_REG_UNKNOWN_090E, 0x0145}, > > + {HI846_REG_UNKNOWN_0954, 0x0089}, > > + {HI846_REG_UNKNOWN_0956, 0x0000}, > > + {HI846_REG_UNKNOWN_0958, 0xCA80}, > > + {HI846_REG_UNKNOWN_095A, 0x9240}, > > + {HI846_REG_PLL_CFG_MIPI2_H, 0x4124}, > > + {HI846_REG_TG_ENABLE, 0x0100}, > > +}; > > + > > +static const struct hi846_reg mode_1280x720_mipi_4lane[] = { > > + /* 360Mbps */ > > + {HI846_REG_UNKNOWN_0900, 0x0300}, > > + {HI846_REG_MIPI_TX_OP_MODE, 0xC319}, > > + {HI846_REG_UNKNOWN_0914, 0xC105}, > > + {HI846_REG_TCLK_PREPARE, 0x030C}, > > + {HI846_REG_UNKNOWN_0918, 0x0304}, > > + {HI846_REG_THS_ZERO, 0x0708}, > > + {HI846_REG_TCLK_POST, 0x0B04}, > > + {HI846_REG_UNKNOWN_091E, 0x0500}, > > + {HI846_REG_UNKNOWN_090C, 0x0208}, > > + {HI846_REG_UNKNOWN_090E, 0x008A}, > > + {HI846_REG_UNKNOWN_0954, 0x0089}, > > + {HI846_REG_UNKNOWN_0956, 0x0000}, > > + {HI846_REG_UNKNOWN_0958, 0xCA80}, > > + {HI846_REG_UNKNOWN_095A, 0x9240}, > > + {HI846_REG_PLL_CFG_MIPI2_H, 0x4924}, > > + {HI846_REG_TG_ENABLE, 0x0100}, > > +}; > > + > > +static const struct hi846_reg mode_1632x1224_config[] = { > > + {HI846_REG_MODE_SELECT, 0x0000}, > > + {HI846_REG_Y_ODD_INC_FOBP, 0x3311}, > > + {HI846_REG_Y_ODD_INC_VACT, 0x3311}, > > + {HI846_REG_Y_ADDR_START_VACT_H, 0x0040}, > > + {HI846_REG_Y_ADDR_END_VACT_H, 0x09CF}, > > + {HI846_REG_UNKNOWN_005C, 0x4202}, > > + {HI846_REG_FLL, 0x09DE}, > > + {HI846_REG_LLP, 0x0ED8}, > > + {HI846_REG_BINNING_MODE, 0x0122}, > > + {HI846_REG_HBIN_MODE, 0x0100}, > > + {HI846_REG_UNKNOWN_0A24, 0x0000}, > > + {HI846_REG_X_START_H, 0x0000}, > > + {HI846_REG_X_OUTPUT_SIZE_H, 0x0660}, > > + {HI846_REG_Y_OUTPUT_SIZE_H, 0x04C8}, > > + {HI846_REG_EXPOSURE, 0x09D8}, > > + {HI846_REG_ISP_EN_H, 0x017A}, > > + > > + /* For OTP */ > > + {HI846_REG_UNKNOWN_021C, 0x0003}, > > + {HI846_REG_UNKNOWN_021E, 0x0235}, > > + > > + {HI846_REG_UNKNOWN_0418, 0x0000}, > > + {HI846_REG_UNKNOWN_0B02, 0xE04D}, > > + {HI846_REG_UNKNOWN_0B10, 0x6C21}, > > + {HI846_REG_UNKNOWN_0B12, 0x0120}, > > + {HI846_REG_UNKNOWN_0B14, 0x0005}, > > + {HI846_REG_UNKNOWN_2008, 0x38FD}, > > + {HI846_REG_UNKNOWN_326E, 0x0000}, > > +}; > > + > > +static const struct hi846_reg mode_1632x1224_mipi_2lane[] = { > > + {HI846_REG_UNKNOWN_0900, 0x0300}, > > + {HI846_REG_MIPI_TX_OP_MODE, 0x4319}, > > + {HI846_REG_UNKNOWN_0914, 0xC109}, > > + {HI846_REG_TCLK_PREPARE, 0x061A}, > > + {HI846_REG_UNKNOWN_0918, 0x0407}, > > + {HI846_REG_THS_ZERO, 0x0A0B}, > > + {HI846_REG_TCLK_POST, 0x0E08}, > > + {HI846_REG_UNKNOWN_091E, 0x0A00}, > > + {HI846_REG_UNKNOWN_090C, 0x0427}, > > + {HI846_REG_UNKNOWN_090E, 0x0069}, > > + {HI846_REG_UNKNOWN_0954, 0x0089}, > > + {HI846_REG_UNKNOWN_0956, 0x0000}, > > + {HI846_REG_UNKNOWN_0958, 0xCA80}, > > + {HI846_REG_UNKNOWN_095A, 0x9240}, > > + {HI846_REG_PLL_CFG_MIPI2_H, 0x4124}, > > + {HI846_REG_TG_ENABLE, 0x0100}, > > +}; > > + > > +static const struct hi846_reg mode_1632x1224_mipi_4lane[] = { > > + {HI846_REG_UNKNOWN_0900, 0x0300}, > > + {HI846_REG_MIPI_TX_OP_MODE, 0xC319}, > > + {HI846_REG_UNKNOWN_0914, 0xC105}, > > + {HI846_REG_TCLK_PREPARE, 0x030C}, > > + {HI846_REG_UNKNOWN_0918, 0x0304}, > > + {HI846_REG_THS_ZERO, 0x0708}, > > + {HI846_REG_TCLK_POST, 0x0B04}, > > + {HI846_REG_UNKNOWN_091E, 0x0500}, > > + {HI846_REG_UNKNOWN_090C, 0x0208}, > > + {HI846_REG_UNKNOWN_090E, 0x001C}, > > + {HI846_REG_UNKNOWN_0954, 0x0089}, > > + {HI846_REG_UNKNOWN_0956, 0x0000}, > > + {HI846_REG_UNKNOWN_0958, 0xCA80}, > > + {HI846_REG_UNKNOWN_095A, 0x9240}, > > + {HI846_REG_PLL_CFG_MIPI2_H, 0x4924}, > > + {HI846_REG_TG_ENABLE, 0x0100}, > > +}; > > + > > +static const char * const hi846_test_pattern_menu[] = { > > + "Disabled", > > + "Solid Colour", > > + "100% Colour Bars", > > + "Fade To Grey Colour Bars", > > + "PN9", > > + "Gradient Horizontal", > > + "Gradient Vertical", > > + "Check Board", > > + "Slant Pattern", > > + "Resolution Pattern", > > +}; > > + > > +#define FREQ_INDEX_640 0 > > +#define FREQ_INDEX_1280 1 > > +static const s64 hi846_link_freqs[] = { > > + [FREQ_INDEX_640] = 80000000, > > + [FREQ_INDEX_1280] = 200000000, > > +}; > > + > > +static const struct hi846_reg_list hi846_init_regs_list_2lane = { > > + .num_of_regs = ARRAY_SIZE(hi846_init_2lane), > > + .regs = hi846_init_2lane, > > +}; > > + > > +static const struct hi846_reg_list hi846_init_regs_list_4lane = { > > + .num_of_regs = ARRAY_SIZE(hi846_init_4lane), > > + .regs = hi846_init_4lane, > > +}; > > + > > +static const struct hi846_mode supported_modes[] = { > > + { > > + .width = 640, > > + .height = 480, > > + .link_freq_index = FREQ_INDEX_640, > > + .fps = 120, > > + .frame_len = 631, > > + .llp = HI846_LINE_LENGTH, > > + .reg_list_config = { > > + .num_of_regs = > > ARRAY_SIZE(mode_640x480_config), > > + .regs = mode_640x480_config, > > + }, > > + .reg_list_2lane = { > > + .num_of_regs = > > ARRAY_SIZE(mode_640x480_mipi_2lane), > > + .regs = mode_640x480_mipi_2lane, > > + }, > > + }, > > + { > > + .width = 1280, > > + .height = 720, > > + .link_freq_index = FREQ_INDEX_1280, > > + .fps = 90, > > + .frame_len = 842, > > + .llp = HI846_LINE_LENGTH, > > + .reg_list_config = { > > + .num_of_regs = > > ARRAY_SIZE(mode_1280x720_config), > > + .regs = mode_1280x720_config, > > + }, > > + .reg_list_2lane = { > > + .num_of_regs = > > ARRAY_SIZE(mode_1280x720_mipi_2lane), > > + .regs = mode_1280x720_mipi_2lane, > > + }, > > + .reg_list_4lane = { > > + .num_of_regs = > > ARRAY_SIZE(mode_1280x720_mipi_4lane), > > + .regs = mode_1280x720_mipi_4lane, > > + }, > > + }, > > + { > > + .width = 1632, > > + .height = 1224, > > + .link_freq_index = FREQ_INDEX_1280, > > + .fps = 30, > > + .frame_len = 2526, > > + .llp = HI846_LINE_LENGTH, > > + .reg_list_config = { > > + .num_of_regs = > > ARRAY_SIZE(mode_1632x1224_config), > > + .regs = mode_1632x1224_config, > > + }, > > + .reg_list_2lane = { > > + .num_of_regs = > > ARRAY_SIZE(mode_1632x1224_mipi_2lane), > > + .regs = mode_1632x1224_mipi_2lane, > > + }, > > + .reg_list_4lane = { > > + .num_of_regs = > > ARRAY_SIZE(mode_1632x1224_mipi_4lane), > > + .regs = mode_1632x1224_mipi_4lane, > > + }, > > + } > > +}; > > + > > +struct hi846_gpio { > > + int gpio; > > + int level; > > +}; > > Please use the gpiod_* API, it will handle the level automatically > for > you. > > > + > > +struct hi846_datafmt { > > + u32 code; > > + enum v4l2_colorspace colorspace; > > +}; > > + > > +struct hi846 { > > + struct hi846_gpio rst_gpio; > > + struct regulator *vdd1_regulator; > > + struct regulator *vdd_regulator; > > + struct clk *clock; > > + struct hi846_datafmt *fmt; > > + struct v4l2_subdev sd; > > + struct media_pad pad; > > + struct v4l2_ctrl_handler ctrl_handler; > > + u8 nr_lanes; > > + > > + struct v4l2_ctrl *link_freq; > > + struct v4l2_ctrl *pixel_rate; > > + struct v4l2_ctrl *vblank; > > + struct v4l2_ctrl *hblank; > > + struct v4l2_ctrl *exposure; > > + > > + const struct hi846_mode *cur_mode; > > + struct mutex mutex; > > + bool streaming; > > +}; > > + > > +static struct hi846_datafmt hi846_colour_fmts[] = { > > This should be const. > > > + {HI846_MEDIA_BUS_FORMAT, V4L2_COLORSPACE_RAW}, > > We usually add a space after { and before }. > > > +}; > > + > > +static struct hi846_datafmt *hi846_find_datafmt(u32 code) > > +{ > > + int i; > > + > > + for (i = 0; i < ARRAY_SIZE(hi846_colour_fmts); i++) > > + if (hi846_colour_fmts[i].code == code) > > + return hi846_colour_fmts + i; > > return &hi846_colour_fmts[i]; > > would be more customary. There are other similar constructs below. > > > + > > + return NULL; > > +} > > + > > +static inline u8 hi846_get_link_freq_index(struct hi846 *hi846) > > +{ > > + return hi846->cur_mode->link_freq_index; > > +} > > + > > +static s64 hi846_get_link_freq(struct hi846 *hi846) > > +{ > > + u8 index = hi846_get_link_freq_index(hi846); > > + > > + return *(hi846_link_freqs + index); > > Here for instance. > > > +} > > + > > +static u64 hi846_calc_pixel_rate(struct hi846 *hi846) > > +{ > > + s64 link_freq = hi846_get_link_freq(hi846); > > + u64 pixel_rate = link_freq * 2 * hi846->nr_lanes; > > + > > + do_div(pixel_rate, HI846_RGB_DEPTH); > > + > > + return pixel_rate; > > +} > > + > > +static int hi846_read_reg(struct hi846 *hi846, u16 reg, u8 *val) > > +{ > > + struct i2c_client *client = v4l2_get_subdevdata(&hi846- > > >sd); > > + struct i2c_msg msgs[2]; > > + u8 addr_buf[2]; > > + u8 data_buf[1] = {0}; > > + int ret; > > + > > + put_unaligned_be16(reg, addr_buf); > > + msgs[0].addr = client->addr; > > + msgs[0].flags = 0; > > + msgs[0].len = sizeof(addr_buf); > > + msgs[0].buf = addr_buf; > > + msgs[1].addr = client->addr; > > + msgs[1].flags = I2C_M_RD; > > + msgs[1].len = 1; > > + msgs[1].buf = &data_buf[0]; > > + > > + ret = i2c_transfer(client->adapter, msgs, > > ARRAY_SIZE(msgs)); > > + if (ret != ARRAY_SIZE(msgs)) { > > + dev_err(&client->dev, "i2c read error: %d\n", ret); > > + return -EIO; > > + } > > + > > + *val = data_buf[0]; > > + > > + return 0; > > +} > > + > > +static int hi846_write_reg_16(struct hi846 *hi846, u16 reg, u16 > > val) > > +{ > > + struct i2c_client *client = v4l2_get_subdevdata(&hi846- > > >sd); > > + u8 buf[6]; > > + > > + put_unaligned_be16(reg, buf); > > + put_unaligned_be32(val << 8 * 2, buf + 2); > > + if (i2c_master_send(client, buf, 4) != 4) > > + return -EIO; > > + > > + return 0; > > +} > > + > > +static int hi846_write_reg_list(struct hi846 *hi846, > > + const struct hi846_reg_list > > *r_list) > > +{ > > + struct i2c_client *client = v4l2_get_subdevdata(&hi846- > > >sd); > > + unsigned int i; > > + int ret; > > + > > + for (i = 0; i < r_list->num_of_regs; i++) { > > + ret = hi846_write_reg_16(hi846, r_list- > > >regs[i].address, > > + r_list->regs[i].val); > > + if (ret) { > > + dev_err_ratelimited(&client->dev, > > + "failed to write reg > > 0x%4.4x. error = %d", > > + r_list- > > >regs[i].address, ret); > > + return ret; > > + } > > + } > > + > > + return 0; > > +} > > + > > +static int hi846_write_reg(struct hi846 *hi846, u16 reg, u8 val) > > +{ > > + struct i2c_client *client = v4l2_get_subdevdata(&hi846- > > >sd); > > + u8 buf[3] = { reg >> 8, reg & 0xff, val }; > > + int ret; > > + > > + struct i2c_msg msg[] = { > > + { .addr = client->addr, .flags = 0, > > + .len = ARRAY_SIZE(buf), .buf = buf }, > > + }; > > + > > + ret = i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg)); > > + if (ret != ARRAY_SIZE(msg)) { > > + dev_err(&client->dev, "i2c write error\n"); > > + return -EIO; > > + } > > + > > + return 0; > > +} > > + > > +static int hi846_update_digital_gain(struct hi846 *hi846, u16 > > d_gain) > > +{ > > + int ret; > > + > > + ret = hi846_write_reg_16(hi846, HI846_REG_MWB_GR_GAIN_H, > > d_gain); > > + if (ret) > > + return ret; > > Let's simplify error checks by passing an error status pointer to the > write function. You can see how that can be implemented at > https://git.linuxtv.org/pinchartl/media.git/tree/drivers/media/i2c/mt9m114.c?h=mt9m114&id=73181111a72ec7171b5c4f84ff3f304ad9a591e6#n681 > . > The code in this function would then become > > int ret = 0; > > hi846_write_reg_16(hi846, HI846_REG_MWB_GR_GAIN_H, d_gain, > &ret); > hi846_write_reg_16(hi846, HI846_REG_MWB_GB_GAIN_H, d_gain, > &ret); > hi846_write_reg_16(hi846, HI846_REG_MWB_R_GAIN_H, d_gain, > &ret); > hi846_write_reg_16(hi846, HI846_REG_MWB_B_GAIN_H, d_gain, > &ret); > > return ret; > > I'd also recommend, given that you have a mix of 8-bit and 16-bit > registers, to use the same mechanism as in the mt9m114 driver to > simplify writes, with the register macro encoding both the address > and > the size. > > > + > > + ret = hi846_write_reg_16(hi846, HI846_REG_MWB_GB_GAIN_H, > > d_gain); > > + if (ret) > > + return ret; > > + > > + ret = hi846_write_reg_16(hi846, HI846_REG_MWB_R_GAIN_H, > > d_gain); > > + if (ret) > > + return ret; > > + > > + return hi846_write_reg_16(hi846, HI846_REG_MWB_B_GAIN_H, > > d_gain); > > +} > > + > > +static int hi846_test_pattern(struct hi846 *hi846, u32 pattern) > > +{ > > + int ret; > > + u8 val; > > + > > + if (pattern) { > > + ret = hi846_read_reg(hi846, HI846_REG_ISP, &val); > > + if (ret) > > + return ret; > > + > > + ret = hi846_write_reg(hi846, HI846_REG_ISP, > > + val | HI846_REG_ISP_TPG_EN); > > + if (ret) > > + return ret; > > + } > > + > > + return hi846_write_reg(hi846, HI846_REG_TEST_PATTERN, > > pattern); > > +} > > + > > +static int hi846_set_ctrl(struct v4l2_ctrl *ctrl) > > +{ > > + struct hi846 *hi846 = container_of(ctrl->handler, > > + struct hi846, > > ctrl_handler); > > + struct i2c_client *client = v4l2_get_subdevdata(&hi846- > > >sd); > > + s64 exposure_max; > > + int ret = 0; > > + u32 shutter, frame_len; > > + > > + if (!pm_runtime_get_if_in_use(&client->dev)) > > + goto out; > > + > > + /* Propagate change of current control to all related > > controls */ > > + if (ctrl->id == V4L2_CID_VBLANK) { > > + /* Update max exposure while meeting expected > > vblanking */ > > + exposure_max = hi846->cur_mode->height + ctrl->val > > - > > + HI846_EXPOSURE_MAX_MARGIN; > > + __v4l2_ctrl_modify_range(hi846->exposure, > > + hi846->exposure->minimum, > > + exposure_max, hi846- > > >exposure->step, > > + exposure_max); > > + } > > + > > + switch (ctrl->id) { > > + case V4L2_CID_ANALOGUE_GAIN: > > + ret = hi846_write_reg(hi846, HI846_REG_ANALOG_GAIN, > > ctrl->val); > > + break; > > + > > + case V4L2_CID_DIGITAL_GAIN: > > + ret = hi846_update_digital_gain(hi846, ctrl->val); > > + break; > > + > > + case V4L2_CID_EXPOSURE: > > + shutter = ctrl->val; > > + frame_len = hi846->cur_mode->frame_len; > > + > > + if (shutter > frame_len - 6) { /* margin */ > > + frame_len = shutter + 6; > > + if (frame_len > 0xffff) { /* max frame len > > */ > > + frame_len = 0xffff; > > + } > > + } > > + > > + if (shutter < 6) > > + shutter = 6; > > + if (shutter > (0xffff - 6)) > > + shutter = 0xffff - 6; > > + > > + ret = hi846_write_reg_16(hi846, HI846_REG_FLL, > > + frame_len); > > + ret = hi846_write_reg_16(hi846, HI846_REG_EXPOSURE, > > + shutter); > > + break; > > + > > + case V4L2_CID_VBLANK: > > + /* Update FLL that meets expected vertical blanking > > */ > > + ret = hi846_write_reg_16(hi846, HI846_REG_FLL, > > + hi846->cur_mode->height + > > ctrl->val); > > + break; > > + case V4L2_CID_TEST_PATTERN: > > + ret = hi846_test_pattern(hi846, ctrl->val); > > + break; > > + > > + default: > > + ret = -EINVAL; > > + break; > > + } > > + > > + pm_runtime_put(&client->dev); > > +out: > > + return ret; > > +} > > + > > +static const struct v4l2_ctrl_ops hi846_ctrl_ops = { > > + .s_ctrl = hi846_set_ctrl, > > +}; > > + > > +static int hi846_init_controls(struct hi846 *hi846) > > +{ > > + struct v4l2_ctrl_handler *ctrl_hdlr; > > + s64 exposure_max, h_blank; > > + int ret; > > + struct i2c_client *client = v4l2_get_subdevdata(&hi846- > > >sd); > > + > > + ctrl_hdlr = &hi846->ctrl_handler; > > + ret = v4l2_ctrl_handler_init(ctrl_hdlr, 8); > > + if (ret) > > + return ret; > > + > > + ctrl_hdlr->lock = &hi846->mutex; > > + > > + hi846->link_freq = v4l2_ctrl_new_int_menu(ctrl_hdlr, > > &hi846_ctrl_ops, > > + > > V4L2_CID_LINK_FREQ, > > + ARRAY_SIZE(hi846_link_freqs > > ) - 1, > > + 0, hi846_link_freqs); > > + if (hi846->link_freq) > > + hi846->link_freq->flags |= > > V4L2_CTRL_FLAG_READ_ONLY; > > + > > + hi846->pixel_rate = v4l2_ctrl_new_std > > + (ctrl_hdlr, &hi846_ctrl_ops, > > + V4L2_CID_PIXEL_RATE, 0, > > + hi846_calc_pixel_rate(hi846), > > + 1, > > + hi846_calc_pixel_rate(hi846)); > > + hi846->vblank = v4l2_ctrl_new_std(ctrl_hdlr, > > &hi846_ctrl_ops, > > + V4L2_CID_VBLANK, > > + hi846->cur_mode- > > >frame_len - > > + hi846->cur_mode->height, > > + HI846_FLL_MAX - > > + hi846->cur_mode->height, > > 1, > > + hi846->cur_mode- > > >frame_len - > > + hi846->cur_mode->height); > > + > > + h_blank = hi846->cur_mode->llp - hi846->cur_mode->width; > > + > > + hi846->hblank = v4l2_ctrl_new_std(ctrl_hdlr, > > &hi846_ctrl_ops, > > + V4L2_CID_HBLANK, h_blank, > > h_blank, 1, > > + h_blank); > > + if (hi846->hblank) > > + hi846->hblank->flags |= V4L2_CTRL_FLAG_READ_ONLY; > > + > > + v4l2_ctrl_new_std(ctrl_hdlr, &hi846_ctrl_ops, > > V4L2_CID_ANALOGUE_GAIN, > > + HI846_ANAL_GAIN_MIN, HI846_ANAL_GAIN_MAX, > > + HI846_ANAL_GAIN_STEP, > > HI846_ANAL_GAIN_MIN); > > + v4l2_ctrl_new_std(ctrl_hdlr, &hi846_ctrl_ops, > > V4L2_CID_DIGITAL_GAIN, > > + HI846_DGTL_GAIN_MIN, HI846_DGTL_GAIN_MAX, > > + HI846_DGTL_GAIN_STEP, > > HI846_DGTL_GAIN_DEFAULT); > > + exposure_max = hi846->cur_mode->frame_len - > > HI846_EXPOSURE_MAX_MARGIN; > > + hi846->exposure = v4l2_ctrl_new_std(ctrl_hdlr, > > &hi846_ctrl_ops, > > + V4L2_CID_EXPOSURE, > > + HI846_EXPOSURE_MIN, > > exposure_max, > > + HI846_EXPOSURE_STEP, > > + exposure_max); > > + v4l2_ctrl_new_std_menu_items(ctrl_hdlr, &hi846_ctrl_ops, > > + V4L2_CID_TEST_PATTERN, > > + > > ARRAY_SIZE(hi846_test_pattern_menu) - 1, > > + 0, 0, > > hi846_test_pattern_menu); > > + if (ctrl_hdlr->error) { > > + dev_err(&client->dev, "v4l ctrl handler error: > > %d\n", > > + ctrl_hdlr->error); > > + return ctrl_hdlr->error; > > + } > > + > > + hi846->sd.ctrl_handler = ctrl_hdlr; > > + > > + return 0; > > +} > > + > > +static int hi846_set_video_mode(struct hi846 *hi846, int fps) > > +{ > > + struct i2c_client *client = v4l2_get_subdevdata(&hi846- > > >sd); > > + int frame_length; > > + int ret; > > + int dummy_lines; > > + s64 link_freq = hi846_get_link_freq(hi846); > > + > > + dev_dbg(&client->dev, "%s: link freq: %lld\n", __func__, > > + hi846_get_link_freq(hi846)); > > + > > + frame_length = do_div(link_freq, do_div(fps, > > HI846_LINE_LENGTH)); > > + dummy_lines = (frame_length > hi846->cur_mode->frame_len) ? > > + (frame_length - hi846->cur_mode->frame_len) > > : 0; > > + > > + frame_length = hi846->cur_mode->frame_len + dummy_lines; > > + > > + dev_dbg(&client->dev, "%s: frame length calculated: %d\n", > > __func__, > > + frame_length); > > + > > + ret = hi846_write_reg_16(hi846, HI846_REG_FLL, frame_length > > & 0xFFFF); > > + ret = hi846_write_reg_16(hi846, HI846_REG_LLP, > > HI846_LINE_LENGTH & 0xFFFF); > > + > > + return ret; > > +} > > + > > +static int hi846_start_streaming(struct hi846 *hi846) > > +{ > > + struct i2c_client *client = v4l2_get_subdevdata(&hi846- > > >sd); > > + int ret = 0; > > + u8 val; > > + > > + if (hi846->nr_lanes == 2) > > + ret = hi846_write_reg_list(hi846, > > &hi846_init_regs_list_2lane); > > + else > > + ret = hi846_write_reg_list(hi846, > > &hi846_init_regs_list_4lane); > > + if (ret) { > > + dev_err(&client->dev, "failed to set plls: %d\n", > > ret); > > + return ret; > > + } > > + > > + ret = hi846_write_reg_list(hi846, &hi846->cur_mode- > > >reg_list_config); > > + if (ret) { > > + dev_err(&client->dev, "failed to set mode: %d\n", > > ret); > > + return ret; > > + } > > + > > + if (hi846->nr_lanes == 2) { > > + if (!&hi846->cur_mode->reg_list_2lane) { > > + dev_err(&client->dev, "2 lanes unsupported > > for this mode\n"); > > + return -EINVAL; > > + } > > + ret = hi846_write_reg_list(hi846, &hi846->cur_mode- > > >reg_list_2lane); > > + } else { > > + if (!&hi846->cur_mode->reg_list_4lane) { > > + dev_err(&client->dev, "4 lanes unsupported > > for this mode\n"); > > + return -EINVAL; > > + } > > + ret = hi846_write_reg_list(hi846, &hi846->cur_mode- > > >reg_list_4lane); > > + } > > + if (ret) { > > + dev_err(&client->dev, "failed to set mipi mode: > > %d\n", ret); > > + return ret; > > + } > > + > > + hi846_set_video_mode(hi846, hi846->cur_mode->fps); > > + > > + ret = __v4l2_ctrl_handler_setup(hi846->sd.ctrl_handler); > > + if (ret) > > + return ret; > > + > > + /* > > + * Reading 0x0034 is purely done for debugging reasons: It > > is not > > + * documented in the DS but only mentioned once: > > + * "If 0x0034[2] bit is disabled , Visible pixel width and > > height is 0." > > + * So even though that sounds like we won't see anything, > > we don't > > + * know more about this, so in that case only inform the > > user but do > > + * nothing more. > > + */ > > + ret = hi846_read_reg(hi846, 0x0034, &val); > > + if (ret) > > + return ret; > > + if (!(val & BIT(2))) > > + dev_info(&client->dev, "visible pixel width and > > height is 0\n"); > > + > > + ret = hi846_write_reg(hi846, HI846_REG_MODE_SELECT, > > + HI846_MODE_STREAMING); > > + if (ret) { > > + dev_err(&client->dev, "failed to start stream"); > > + return ret; > > + } > > + > > + hi846->streaming = 1; > > + > > + dev_dbg(&client->dev, "%s: started streaming > > successfully\n", __func__); > > + > > + return ret; > > +} > > + > > +static void hi846_stop_streaming(struct hi846 *hi846) > > +{ > > + struct i2c_client *client = v4l2_get_subdevdata(&hi846- > > >sd); > > + > > + if (hi846_write_reg(hi846, HI846_REG_MODE_SELECT, > > HI846_MODE_STANDBY)) > > + dev_err(&client->dev, "failed to stop stream"); > > + > > + hi846->streaming = 0; > > +} > > + > > +static int hi846_set_stream(struct v4l2_subdev *sd, int enable) > > +{ > > + struct hi846 *hi846 = to_hi846(sd); > > + struct i2c_client *client = v4l2_get_subdevdata(sd); > > + int ret = 0; > > + > > + if (hi846->streaming == enable) > > + return 0; > > + > > + mutex_lock(&hi846->mutex); > > + > > + if (enable) { > > + ret = pm_runtime_get_sync(&client->dev); > > + if (ret < 0) { > > + pm_runtime_put_noidle(&client->dev); > > + goto out; > > + } > > + > > + ret = hi846_start_streaming(hi846); > > + if (ret) { > > + enable = 0; > > + hi846_stop_streaming(hi846); > > + pm_runtime_put(&client->dev); > > + } > > + } else { > > + hi846_stop_streaming(hi846); > > + pm_runtime_put(&client->dev); > > + } > > + > > +out: > > + mutex_unlock(&hi846->mutex); > > + > > + return ret; > > +} > > + > > +static int hi846_regulator_enable(struct hi846 *hi846) > > +{ > > + int ret = 0; > > + > > + ret = regulator_enable(hi846->vdd_regulator); > > + if (ret) > > + return ret; > > + > > + return regulator_enable(hi846->vdd1_regulator); > > If this fails, vdd should be disabled. You can use the bulk regulator > API to handle this. > > > +} > > + > > +static void hi846_regulator_disable(struct hi846 *hi846) > > +{ > > + if (regulator_is_enabled(hi846->vdd1_regulator)) > > + regulator_disable(hi846->vdd1_regulator); > > Regulator enable/disable calls always need to be balanced, checking > if > the regulator is enabled before disabling it is most often not > correct. > > > + > > + if (regulator_is_enabled(hi846->vdd_regulator)) > > + regulator_disable(hi846->vdd_regulator); > > +} > > + > > +static int __maybe_unused hi846_suspend(struct device *dev) > > +{ > > + struct i2c_client *client = to_i2c_client(dev); > > + struct v4l2_subdev *sd = i2c_get_clientdata(client); > > + struct hi846 *hi846 = to_hi846(sd); > > + > > + if (hi846->streaming) > > + hi846_stop_streaming(hi846); > > + > > + if (!IS_ERR(hi846->clock)) > > Can this happen ? > > > + clk_disable_unprepare(hi846->clock); > > + > > + hi846_regulator_disable(hi846); > > + > > + return 0; > > +} > > + > > +static int __maybe_unused hi846_resume(struct device *dev) > > +{ > > + struct i2c_client *client = to_i2c_client(dev); > > + struct v4l2_subdev *sd = i2c_get_clientdata(client); > > + struct hi846 *hi846 = to_hi846(sd); > > + int ret; > > + > > + ret = hi846_regulator_enable(hi846); > > + if (ret) { > > + dev_err(dev, "enable regulator failed: %d\n", ret); > > + return ret; > > + } > > + > > + ret = clk_prepare_enable(hi846->clock); > > + if (ret < 0) { > > + dev_err(dev, "enable clk failed: %d\n", ret); > > + goto error_regulator; > > + } > > + > > + msleep(100); > > + > > + if (hi846->streaming) { > > + ret = hi846_start_streaming(hi846); > > + if (ret) { > > + dev_err(dev, "%s: start streaming failed: > > %d\n", > > + __func__, ret); > > + goto error; > > + } > > + } > > + > > + return 0; > > + > > +error: > > + clk_disable_unprepare(hi846->clock); > > + > > +error_regulator: > > + hi846_regulator_disable(hi846); > > + > > + return ret; > > +} > > + > > +static int hi846_set_format(struct v4l2_subdev *sd, > > + struct v4l2_subdev_pad_config *cfg, > > + struct v4l2_subdev_format *format) > > +{ > > + struct hi846 *hi846 = to_hi846(sd); > > + struct v4l2_mbus_framefmt *mf = &format->format; > > + struct i2c_client *client = v4l2_get_subdevdata(sd); > > + struct hi846_datafmt *fmt = hi846_find_datafmt(mf->code); > > + u32 tgt_fps; > > + s32 vblank_def, h_blank; > > + > > + if (!fmt) { > > + mf->code = hi846_colour_fmts[0].code; > > + mf->colorspace = hi846_colour_fmts[0].colorspace; > > + fmt = &hi846_colour_fmts[0]; > > + } > > + > > + if (format->which == V4L2_SUBDEV_FORMAT_TRY) { > > + *v4l2_subdev_get_try_format(sd, cfg, format->pad) = > > *mf; > > + return 0; > > + } > > + > > + mutex_lock(&hi846->mutex); > > + > > + if (hi846->streaming) { > > + mutex_unlock(&hi846->mutex); > > + return -EBUSY; > > + } > > + > > + hi846->fmt = fmt; > > + > > + hi846->cur_mode = v4l2_find_nearest_size(supported_modes, > > + ARRAY_SIZE(supported_modes), > > width, > > + height, mf->width, > > + mf->height); > > + dev_dbg(&client->dev, "%s: found mode: %dx%d\n", __func__, > > + hi846->cur_mode->width, hi846->cur_mode->height); > > + > > + tgt_fps = hi846->cur_mode->fps; > > + dev_dbg(&client->dev, "%s: target fps: %d\n", __func__, > > tgt_fps); > > + > > + mf->width = hi846->cur_mode->width; > > + mf->height = hi846->cur_mode->height; > > + mf->code = HI846_MEDIA_BUS_FORMAT; > > + mf->field = V4L2_FIELD_NONE; > > + > > + __v4l2_ctrl_s_ctrl(hi846->link_freq, > > hi846_get_link_freq_index(hi846)); > > + __v4l2_ctrl_s_ctrl_int64(hi846->pixel_rate, > > + hi846_calc_pixel_rate(hi846)); > > + > > + /* Update limits and set FPS to default */ > > + vblank_def = hi846->cur_mode->frame_len - hi846->cur_mode- > > >height; > > + __v4l2_ctrl_modify_range(hi846->vblank, > > + hi846->cur_mode->frame_len - > > hi846->cur_mode->height, > > + HI846_FLL_MAX - hi846->cur_mode- > > >height, 1, > > + vblank_def); > > + __v4l2_ctrl_s_ctrl(hi846->vblank, vblank_def); > > + > > + h_blank = hi846->cur_mode->llp - hi846->cur_mode->width; > > + > > + __v4l2_ctrl_modify_range(hi846->hblank, h_blank, h_blank, > > 1, > > + h_blank); > > + > > + dev_dbg(&client->dev, "Set fmt w=%d h=%d code=0x%x > > colorspace=0x%x\n", > > + mf->width, mf->height, > > + fmt->code, fmt->colorspace); > > + > > + mutex_unlock(&hi846->mutex); > > + > > + return 0; > > +} > > + > > +static int hi846_get_format(struct v4l2_subdev *sd, > > + struct v4l2_subdev_pad_config *cfg, > > + struct v4l2_subdev_format *format) > > +{ > > + struct hi846 *hi846 = to_hi846(sd); > > + struct v4l2_mbus_framefmt *mf = &format->format; > > + struct i2c_client *client = v4l2_get_subdevdata(sd); > > + > > + if (format->pad) > > + return -EINVAL; > > + > > + if (format->which == V4L2_SUBDEV_FORMAT_TRY) { > > + format->format = > > *v4l2_subdev_get_try_format(&hi846->sd, > > + cfg, > > + format- > > >pad); > > + return 0; > > + } > > + > > + mutex_lock(&hi846->mutex); > > + mf->code = HI846_MEDIA_BUS_FORMAT; > > + mf->colorspace = V4L2_COLORSPACE_RAW; > > + mf->field = V4L2_FIELD_NONE; > > + mf->width = hi846->cur_mode->width; > > + mf->height = hi846->cur_mode->height; > > + mutex_unlock(&hi846->mutex); > > + dev_dbg(&client->dev, > > + "Get format w=%d h=%d code=0x%x colorspace=0x%x\n", > > + mf->width, mf->height, mf->code, mf->colorspace); > > + > > + return 0; > > +} > > + > > +static int hi846_enum_mbus_code(struct v4l2_subdev *sd, > > + struct v4l2_subdev_pad_config *cfg, > > + struct v4l2_subdev_mbus_code_enum > > *code) > > +{ > > + if (code->pad || code->index > 0) > > + return -EINVAL; > > + > > + code->code = HI846_MEDIA_BUS_FORMAT; > > + > > + return 0; > > +} > > + > > +static int hi846_enum_frame_size(struct v4l2_subdev *sd, > > + struct v4l2_subdev_pad_config > > *cfg, > > + struct v4l2_subdev_frame_size_enum > > *fse) > > +{ > > + struct i2c_client *client = v4l2_get_subdevdata(sd); > > + > > + if (fse->pad || fse->index >= ARRAY_SIZE(supported_modes)) > > + return -EINVAL; > > + > > + if (fse->code != HI846_MEDIA_BUS_FORMAT) { > > + dev_err(&client->dev, "frame size enum not > > matching\n"); > > + return -EINVAL; > > + } > > + > > + fse->min_width = supported_modes[fse->index].width; > > + fse->max_width = supported_modes[fse->index].width; > > + fse->min_height = supported_modes[fse->index].height; > > + fse->max_height = supported_modes[fse->index].height; > > + > > + dev_dbg(&client->dev, "%s: max width: %d max height: %d\n", > > __func__, > > + fse->max_width, fse->max_height); > > + > > + return 0; > > +} > > + > > +static int hi846_s_power(struct v4l2_subdev *sd, int on) > > +{ > > + struct hi846 *hi846 = to_hi846(sd); > > + struct i2c_client *client = v4l2_get_subdevdata(sd); > > + struct device *dev = &client->dev; > > + int ret = 0; > > + > > + mutex_lock(&hi846->mutex); > > + if (on) { > > + ret = hi846_resume(dev); > > + if (ret) > > + goto out; > > + } else { > > + ret = hi846_suspend(dev); > > + if (ret) > > + goto out; > > + } > > +out: > > + mutex_unlock(&hi846->mutex); > > + return ret; > > +} > > + > > +static int hi846_open(struct v4l2_subdev *sd, struct > > v4l2_subdev_fh *fh) > > +{ > > + struct hi846 *hi846 = to_hi846(sd); > > + struct v4l2_mbus_framefmt *mf; > > + > > + mf = v4l2_subdev_get_try_format(sd, fh->pad, 0); > > + > > + mutex_lock(&hi846->mutex); > > + mf->code = HI846_MEDIA_BUS_FORMAT; > > + mf->colorspace = V4L2_COLORSPACE_RAW; > > + mf->field = V4L2_FIELD_NONE; > > + mf->width = hi846->cur_mode->width; > > + mf->height = hi846->cur_mode->height; > > + mutex_unlock(&hi846->mutex); > > + > > + return 0; > > +} > > Initialization of the try format is better performed in the > .init_cfg() > function, you can then drop .open(). > > > + > > +static const struct v4l2_subdev_video_ops hi846_video_ops = { > > + .s_stream = hi846_set_stream, > > +}; > > + > > +static const struct v4l2_subdev_pad_ops hi846_pad_ops = { > > + .enum_frame_size = hi846_enum_frame_size, > > + .enum_mbus_code = hi846_enum_mbus_code, > > + .set_fmt = hi846_set_format, > > + .get_fmt = hi846_get_format, > > Please also implement .get_selection() to allow querying the CROP, > CROP_BOUNDS and CROP_DEFAULT. The first one can depend on the current > mode, the last two should be fixed. > > > +}; > > + > > +static struct v4l2_subdev_core_ops hi846_core_ops = { > > This should be const. > > > + .s_power = hi846_s_power, > > .s_power() is deprecated, power should be controlled at .s_stream() > time > with runtime PM, and the driver should use the runtime PM autoidle > feature. > > > + .log_status = v4l2_ctrl_subdev_log_status, > > +}; > > + > > +static const struct v4l2_subdev_ops hi846_subdev_ops = { > > + .core = &hi846_core_ops, > > + .video = &hi846_video_ops, > > + .pad = &hi846_pad_ops, > > +}; > > + > > +static const struct media_entity_operations > > hi846_subdev_entity_ops = { > > + .link_validate = v4l2_subdev_link_validate, > > +}; > > + > > +static const struct v4l2_subdev_internal_ops hi846_internal_ops = > > { > > + .open = hi846_open, > > +}; > > + > > +static void hi846_rst_gpio_assert(struct hi846 *hi846, bool on) > > +{ > > + struct hi846_gpio *gpio = &hi846->rst_gpio; > > + > > + if (gpio == NULL) > > + return; > > + > > + if (on) > > + gpio_set_value(gpio->gpio, gpio->level); > > + else > > + gpio_set_value(gpio->gpio, !gpio->level); > > +} > > + > > +static int hi846_parse_gpio(struct hi846_gpio *gpio, struct device > > *dev) > > +{ > > + struct device_node *node = dev->of_node; > > + enum of_gpio_flags flags; > > + int ret; > > + > > + ret = of_get_named_gpio_flags(node, "reset-gpios", 0, > > &flags); > > + if (ret < 0) { > > + dev_err(dev, "no reset-gpios provided: %d\n", ret); > > + return ret; > > + } > > + gpio->gpio = ret; > > + gpio->level = !(flags & OF_GPIO_ACTIVE_LOW); > > + > > + return 0; > > +} > > + > > +static int hi846_identify_module(struct hi846 *hi846) > > +{ > > + struct i2c_client *client = v4l2_get_subdevdata(&hi846- > > >sd); > > + int ret; > > + u8 hi, lo; > > + > > + ret = hi846_read_reg(hi846, HI846_REG_CHIP_ID_L, &lo); > > + if (ret) > > + return ret; > > + > > + if (lo != HI846_CHIP_ID_L) { > > + dev_err(&client->dev, "wrong chip id low byte: %x", > > lo); > > + return -ENXIO; > > + } > > + > > + ret = hi846_read_reg(hi846, HI846_REG_CHIP_ID_H, &hi); > > + if (ret) > > + return ret; > > + > > + if (hi != HI846_CHIP_ID_H) { > > + dev_err(&client->dev, "wrong chip id high byte: > > %x", hi); > > + return -ENXIO; > > + } > > + > > + dev_info(&client->dev, "chip id %02X %02X using %d mipi > > lanes\n", hi, lo, > > + hi846->nr_lanes); > > + > > + return 0; > > +} > > + > > +static int hi846_check_hwcfg(struct device *dev, u8 *lanes) > > +{ > > + struct fwnode_handle *ep; > > + struct fwnode_handle *fwnode = dev_fwnode(dev); > > + struct v4l2_fwnode_endpoint bus_cfg = { > > + .bus_type = V4L2_MBUS_CSI2_DPHY > > + }; > > + int ret = 0; > > No need to initialize ret to 0. > > > + > > + if (!fwnode) > > + return -ENXIO; > > Can this happen ? > > > + > > + ep = fwnode_graph_get_next_endpoint(fwnode, NULL); > > + if (!ep) > > An error message would be nice. > > > + return -ENXIO; > > + > > + ret = v4l2_fwnode_endpoint_alloc_parse(ep, &bus_cfg); > > + fwnode_handle_put(ep); > > + if (ret) > > Same here. > > > + return ret; > > + > > + if (bus_cfg.bus.mipi_csi2.num_data_lanes != 2 && > > + bus_cfg.bus.mipi_csi2.num_data_lanes != 4) { > > + dev_err(dev, "number of CSI2 data lanes %d is not > > supported", > > + bus_cfg.bus.mipi_csi2.num_data_lanes); > > + ret = -EINVAL; > > + goto check_hwcfg_error; > > + } > > + > > + *lanes = bus_cfg.bus.mipi_csi2.num_data_lanes; > > + > > +check_hwcfg_error: > > + v4l2_fwnode_endpoint_free(&bus_cfg); > > + > > + return ret; > > +} > > + > > +static int hi846_remove(struct i2c_client *client) > > +{ > > + struct v4l2_subdev *sd = i2c_get_clientdata(client); > > + struct hi846 *hi846 = to_hi846(sd); > > + > > + v4l2_async_unregister_subdev(sd); > > + media_entity_cleanup(&sd->entity); > > + v4l2_ctrl_handler_free(sd->ctrl_handler); > > + > > + pm_runtime_disable(&client->dev); > > + if (!pm_runtime_status_suspended(&client->dev)) > > + hi846_suspend(&client->dev); > > + pm_runtime_set_suspended(&client->dev); > > + > > + mutex_destroy(&hi846->mutex); > > + > > + return 0; > > +} > > It's customary to place remove() after probe() (but not required). > > > + > > +static int hi846_probe(struct i2c_client *client) > > +{ > > + struct hi846 *hi846; > > + int ret; > > + u8 lanes; > > + > > + ret = hi846_check_hwcfg(&client->dev, &lanes); > > + if (ret) { > > + dev_err(&client->dev, "failed to check HW > > configuration: %d", > > + ret); > > + return ret; > > + } > > I'd move this after the devm_kzalloc(). The function will then be > able > to set hi846->nr_lanes directly. I'd also rename it to > hi846_parse_dt() > or something similar. > > > + > > + hi846 = devm_kzalloc(&client->dev, sizeof(*hi846), > > GFP_KERNEL); > > + if (!hi846) > > + return -ENOMEM; > > + > > + hi846->nr_lanes = lanes; > > + > > + v4l2_i2c_subdev_init(&hi846->sd, client, > > &hi846_subdev_ops); > > Let's acquire all the resources (GPIOs, clocks and regulators) before > dealing with subdev initialization. > > > + > > + ret = hi846_parse_gpio(&hi846->rst_gpio, &client->dev); > > + if (ret < 0) { > > + dev_err(&client->dev, "parse gpio failed: %d\n", > > ret); > > + return ret; > > + } > > + > > + hi846->vdd_regulator = devm_regulator_get(&client->dev, > > "vdd"); > > + if (IS_ERR(hi846->vdd_regulator)) > > + dev_warn(&client->dev, "cannot get voltage > > regulator\n"); > > + > > + hi846->vdd1_regulator = devm_regulator_get(&client->dev, > > "vdd1"); > > Not documented in the DT bindings, and there's no VDD1 supply in the > datasheet. > > > + if (IS_ERR(hi846->vdd1_regulator)) > > + dev_warn(&client->dev, "cannot get voltage > > regulator\n"); > > + > > + ret = hi846_regulator_enable(hi846); > > + if (ret) { > > + dev_err(&client->dev, "regulator enable failed: > > %d\n", ret); > > + return ret; > > + } > > And let's move the regualtor enable with the clock prepare below. I'd > actually move the regulator enable, clock enable and reset handling > to a > separate hi846_power_on() function, as you need to do the same here > and > in hi846_resume(). Same for power off. > > > + > > + hi846->clock = devm_clk_get(hi846->sd.dev, "mclk"); > > + if (IS_ERR(hi846->clock)) { > > + dev_err(&client->dev, "get clk failed\n"); > > + ret = -EPROBE_DEFER; > > + goto probe_error_regulator; > > + } > > + > > + ret = clk_prepare_enable(hi846->clock); > > + if (ret < 0) > > + goto probe_error_regulator; > > + > > + msleep(100); > > I see corresponding delay in the datasheet. There's however a 2400 > MCLK > cycles delay required after deassering RESETB before issuing the > first > I2C transaction. > > Thank you, Laurent for that wonderful review. It made me rework/fix the power supply interface + sequencing in the driver (and even better understand how it's supplied on my board). I want to take all your review into account for a next revision, except for the additional bits for the register definitions, that should encode the length, if that's ok. We can choose whether to write 1 or 2 bytes at a given address and it just looks nice and simple to me as it is. so long, martin ^ permalink raw reply [flat|nested] 14+ messages in thread
* Re: [PATCH v3 3/5] media: i2c: add driver for the SK Hynix Hi-846 8M pixel camera 2021-06-02 12:00 ` Martin Kepplinger @ 2021-06-02 17:57 ` Laurent Pinchart 0 siblings, 0 replies; 14+ messages in thread From: Laurent Pinchart @ 2021-06-02 17:57 UTC (permalink / raw) To: Martin Kepplinger Cc: pavel, krzysztof.kozlowski, mchehab, paul.kocialkowski, robh, shawnx.tu, devicetree, kernel, linux-kernel, linux-media, phone-devel Hi Martin, On Wed, Jun 02, 2021 at 02:00:11PM +0200, Martin Kepplinger wrote: > Am Dienstag, dem 01.06.2021 um 03:14 +0300 schrieb Laurent Pinchart: > > On Mon, May 31, 2021 at 02:07:35PM +0200, Martin Kepplinger wrote: > > > The SK Hynix Hi-846 is a 1/4" 8M Pixel CMOS Image Sensor. It supports > > > usual features like I2C control, CSI-2 for frame data, digital/analog > > > gain control or test patterns. > > > > > > This driver supports the 640x480, 1280x720 and 1632x1224 resolution > > > modes. It supports runtime PM in order not to draw any unnecessary > > > power. > > > > > > The part is also called YACG4D0C9SHC and a datasheet can be found at > > > https://product.skhynix.com/products/cis/cis.go > > > > > > The large sets of partly undocumented register values are for example > > > found when searching for the hi846_mipi_raw_Sensor.c Android driver. > > > > A common story, unfortunately :-S > > > > I've done an initial review, I'll likely have more comments on v4, but > > you should have quite a few things to address already :-) > > > > > Signed-off-by: Martin Kepplinger <martin.kepplinger@puri.sm> > > > --- > > > MAINTAINERS | 6 + > > > drivers/media/i2c/Kconfig | 13 + > > > drivers/media/i2c/Makefile | 1 + > > > drivers/media/i2c/hi846.c | 2138 ++++++++++++++++++++++++++++++++++++ > > > 4 files changed, 2158 insertions(+) > > > create mode 100644 drivers/media/i2c/hi846.c [snip] > Thank you, Laurent for that wonderful review. It made me rework/fix the > power supply interface + sequencing in the driver (and even better > understand how it's supplied on my board). > > I want to take all your review into account for a next revision, except > for the additional bits for the register definitions, that should > encode the length, if that's ok. We can choose whether to write 1 or 2 > bytes at a given address and it just looks nice and simple to me as it > is. I won't push strongly, but in my experience it's error-prone, as it's easy to select the incorrect number of bytes. That's what led me to create this mechanism to bundle register addresses and sizes, it has simplified my life when writing drivers. I think it should actually be turned into a helper, possibly provided by regmap. -- Regards, Laurent Pinchart ^ permalink raw reply [flat|nested] 14+ messages in thread
* Re: [PATCH v3 3/5] media: i2c: add driver for the SK Hynix Hi-846 8M pixel camera 2021-05-31 12:07 ` [PATCH v3 3/5] media: i2c: add driver for the SK Hynix Hi-846 8M pixel camera Martin Kepplinger @ 2021-06-01 6:50 ` kernel test robot 2021-06-01 6:50 ` kernel test robot 1 sibling, 0 replies; 14+ messages in thread From: kernel test robot @ 2021-06-01 6:50 UTC (permalink / raw) To: Martin Kepplinger, pavel, krzysztof.kozlowski, laurent.pinchart, mchehab, paul.kocialkowski, robh, shawnx.tu Cc: kbuild-all, devicetree, kernel, linux-kernel [-- Attachment #1: Type: text/plain, Size: 6984 bytes --] Hi Martin, I love your patch! Yet something to improve: [auto build test ERROR on linuxtv-media/master] [also build test ERROR on robh/for-next pavel-linux-leds/for-next v5.13-rc4 next-20210528] [If your patch is applied to the wrong git tree, kindly drop us a note. And when submitting patch, we suggest to use '--base' as documented in https://git-scm.com/docs/git-format-patch] url: https://github.com/0day-ci/linux/commits/Martin-Kepplinger/Add-support-for-the-Hynix-Hi-846-camera/20210531-200931 base: git://linuxtv.org/media_tree.git master config: nios2-allyesconfig (attached as .config) compiler: nios2-linux-gcc (GCC) 9.3.0 reproduce (this is a W=1 build): wget https://raw.githubusercontent.com/intel/lkp-tests/master/sbin/make.cross -O ~/bin/make.cross chmod +x ~/bin/make.cross # https://github.com/0day-ci/linux/commit/990f55e1171e0120ffbbb77faac9b75091f105f2 git remote add linux-review https://github.com/0day-ci/linux git fetch --no-tags linux-review Martin-Kepplinger/Add-support-for-the-Hynix-Hi-846-camera/20210531-200931 git checkout 990f55e1171e0120ffbbb77faac9b75091f105f2 # save the attached .config to linux build tree COMPILER_INSTALL_PATH=$HOME/0day COMPILER=gcc-9.3.0 make.cross ARCH=nios2 If you fix the issue, kindly add following tag as appropriate Reported-by: kernel test robot <lkp@intel.com> All errors (new ones prefixed by >>): In file included from ./arch/nios2/include/generated/asm/div64.h:1, from include/linux/math.h:5, from include/linux/kernel.h:14, from include/linux/unaligned/packed_struct.h:4, from include/linux/unaligned/le_struct.h:5, from include/asm-generic/unaligned.h:18, from ./arch/nios2/include/generated/asm/unaligned.h:1, from drivers/media/i2c/hi846.c:4: drivers/media/i2c/hi846.c: In function 'hi846_set_video_mode': include/asm-generic/div64.h:228:28: warning: comparison of distinct pointer types lacks a cast 228 | (void)(((typeof((n)) *)0) == ((uint64_t *)0)); \ | ^~ include/asm-generic/div64.h:226:21: note: in definition of macro 'do_div' 226 | uint32_t __base = (base); \ | ^~~~ drivers/media/i2c/hi846.c:1469:35: note: in expansion of macro 'do_div' 1469 | frame_length = do_div(link_freq, do_div(fps, HI846_LINE_LENGTH)); | ^~~~~~ include/asm-generic/div64.h:241:25: warning: right shift count >= width of type [-Wshift-count-overflow] 241 | } else if (likely(((n) >> 32) == 0)) { \ | ^~ include/asm-generic/div64.h:226:21: note: in definition of macro 'do_div' 226 | uint32_t __base = (base); \ | ^~~~ include/asm-generic/div64.h:241:13: note: in expansion of macro 'likely' 241 | } else if (likely(((n) >> 32) == 0)) { \ | ^~~~~~ drivers/media/i2c/hi846.c:1469:35: note: in expansion of macro 'do_div' 1469 | frame_length = do_div(link_freq, do_div(fps, HI846_LINE_LENGTH)); | ^~~~~~ >> include/asm-generic/div64.h:245:22: error: passing argument 1 of '__div64_32' from incompatible pointer type [-Werror=incompatible-pointer-types] 245 | __rem = __div64_32(&(n), __base); \ | ^~~~ | | | int * include/asm-generic/div64.h:226:21: note: in definition of macro 'do_div' 226 | uint32_t __base = (base); \ | ^~~~ drivers/media/i2c/hi846.c:1469:35: note: in expansion of macro 'do_div' 1469 | frame_length = do_div(link_freq, do_div(fps, HI846_LINE_LENGTH)); | ^~~~~~ include/asm-generic/div64.h:219:38: note: expected 'uint64_t *' {aka 'long long unsigned int *'} but argument is of type 'int *' 219 | extern uint32_t __div64_32(uint64_t *dividend, uint32_t divisor); | ~~~~~~~~~~^~~~~~~~ include/asm-generic/div64.h:228:28: warning: comparison of distinct pointer types lacks a cast 228 | (void)(((typeof((n)) *)0) == ((uint64_t *)0)); \ | ^~ drivers/media/i2c/hi846.c:1469:17: note: in expansion of macro 'do_div' 1469 | frame_length = do_div(link_freq, do_div(fps, HI846_LINE_LENGTH)); | ^~~~~~ cc1: some warnings being treated as errors vim +/__div64_32 +245 include/asm-generic/div64.h ^1da177e4c3f41 Linus Torvalds 2005-04-16 221 ^1da177e4c3f41 Linus Torvalds 2005-04-16 222 /* The unnecessary pointer compare is there ^1da177e4c3f41 Linus Torvalds 2005-04-16 223 * to check for type safety (n must be 64bit) ^1da177e4c3f41 Linus Torvalds 2005-04-16 224 */ ^1da177e4c3f41 Linus Torvalds 2005-04-16 225 # define do_div(n,base) ({ \ ^1da177e4c3f41 Linus Torvalds 2005-04-16 226 uint32_t __base = (base); \ ^1da177e4c3f41 Linus Torvalds 2005-04-16 227 uint32_t __rem; \ ^1da177e4c3f41 Linus Torvalds 2005-04-16 228 (void)(((typeof((n)) *)0) == ((uint64_t *)0)); \ 911918aa7ef6f8 Nicolas Pitre 2015-11-02 229 if (__builtin_constant_p(__base) && \ 911918aa7ef6f8 Nicolas Pitre 2015-11-02 230 is_power_of_2(__base)) { \ 911918aa7ef6f8 Nicolas Pitre 2015-11-02 231 __rem = (n) & (__base - 1); \ 911918aa7ef6f8 Nicolas Pitre 2015-11-02 232 (n) >>= ilog2(__base); \ 461a5e51060c93 Nicolas Pitre 2015-10-30 233 } else if (__div64_const32_is_OK && \ 461a5e51060c93 Nicolas Pitre 2015-10-30 234 __builtin_constant_p(__base) && \ 461a5e51060c93 Nicolas Pitre 2015-10-30 235 __base != 0) { \ 461a5e51060c93 Nicolas Pitre 2015-10-30 236 uint32_t __res_lo, __n_lo = (n); \ 461a5e51060c93 Nicolas Pitre 2015-10-30 237 (n) = __div64_const32(n, __base); \ 461a5e51060c93 Nicolas Pitre 2015-10-30 238 /* the remainder can be computed with 32-bit regs */ \ 461a5e51060c93 Nicolas Pitre 2015-10-30 239 __res_lo = (n); \ 461a5e51060c93 Nicolas Pitre 2015-10-30 240 __rem = __n_lo - __res_lo * __base; \ 911918aa7ef6f8 Nicolas Pitre 2015-11-02 241 } else if (likely(((n) >> 32) == 0)) { \ ^1da177e4c3f41 Linus Torvalds 2005-04-16 242 __rem = (uint32_t)(n) % __base; \ ^1da177e4c3f41 Linus Torvalds 2005-04-16 243 (n) = (uint32_t)(n) / __base; \ ^1da177e4c3f41 Linus Torvalds 2005-04-16 244 } else \ ^1da177e4c3f41 Linus Torvalds 2005-04-16 @245 __rem = __div64_32(&(n), __base); \ ^1da177e4c3f41 Linus Torvalds 2005-04-16 246 __rem; \ ^1da177e4c3f41 Linus Torvalds 2005-04-16 247 }) ^1da177e4c3f41 Linus Torvalds 2005-04-16 248 --- 0-DAY CI Kernel Test Service, Intel Corporation https://lists.01.org/hyperkitty/list/kbuild-all@lists.01.org [-- Attachment #2: .config.gz --] [-- Type: application/gzip, Size: 59654 bytes --] ^ permalink raw reply [flat|nested] 14+ messages in thread
* Re: [PATCH v3 3/5] media: i2c: add driver for the SK Hynix Hi-846 8M pixel camera @ 2021-06-01 6:50 ` kernel test robot 0 siblings, 0 replies; 14+ messages in thread From: kernel test robot @ 2021-06-01 6:50 UTC (permalink / raw) To: kbuild-all [-- Attachment #1: Type: text/plain, Size: 7102 bytes --] Hi Martin, I love your patch! Yet something to improve: [auto build test ERROR on linuxtv-media/master] [also build test ERROR on robh/for-next pavel-linux-leds/for-next v5.13-rc4 next-20210528] [If your patch is applied to the wrong git tree, kindly drop us a note. And when submitting patch, we suggest to use '--base' as documented in https://git-scm.com/docs/git-format-patch] url: https://github.com/0day-ci/linux/commits/Martin-Kepplinger/Add-support-for-the-Hynix-Hi-846-camera/20210531-200931 base: git://linuxtv.org/media_tree.git master config: nios2-allyesconfig (attached as .config) compiler: nios2-linux-gcc (GCC) 9.3.0 reproduce (this is a W=1 build): wget https://raw.githubusercontent.com/intel/lkp-tests/master/sbin/make.cross -O ~/bin/make.cross chmod +x ~/bin/make.cross # https://github.com/0day-ci/linux/commit/990f55e1171e0120ffbbb77faac9b75091f105f2 git remote add linux-review https://github.com/0day-ci/linux git fetch --no-tags linux-review Martin-Kepplinger/Add-support-for-the-Hynix-Hi-846-camera/20210531-200931 git checkout 990f55e1171e0120ffbbb77faac9b75091f105f2 # save the attached .config to linux build tree COMPILER_INSTALL_PATH=$HOME/0day COMPILER=gcc-9.3.0 make.cross ARCH=nios2 If you fix the issue, kindly add following tag as appropriate Reported-by: kernel test robot <lkp@intel.com> All errors (new ones prefixed by >>): In file included from ./arch/nios2/include/generated/asm/div64.h:1, from include/linux/math.h:5, from include/linux/kernel.h:14, from include/linux/unaligned/packed_struct.h:4, from include/linux/unaligned/le_struct.h:5, from include/asm-generic/unaligned.h:18, from ./arch/nios2/include/generated/asm/unaligned.h:1, from drivers/media/i2c/hi846.c:4: drivers/media/i2c/hi846.c: In function 'hi846_set_video_mode': include/asm-generic/div64.h:228:28: warning: comparison of distinct pointer types lacks a cast 228 | (void)(((typeof((n)) *)0) == ((uint64_t *)0)); \ | ^~ include/asm-generic/div64.h:226:21: note: in definition of macro 'do_div' 226 | uint32_t __base = (base); \ | ^~~~ drivers/media/i2c/hi846.c:1469:35: note: in expansion of macro 'do_div' 1469 | frame_length = do_div(link_freq, do_div(fps, HI846_LINE_LENGTH)); | ^~~~~~ include/asm-generic/div64.h:241:25: warning: right shift count >= width of type [-Wshift-count-overflow] 241 | } else if (likely(((n) >> 32) == 0)) { \ | ^~ include/asm-generic/div64.h:226:21: note: in definition of macro 'do_div' 226 | uint32_t __base = (base); \ | ^~~~ include/asm-generic/div64.h:241:13: note: in expansion of macro 'likely' 241 | } else if (likely(((n) >> 32) == 0)) { \ | ^~~~~~ drivers/media/i2c/hi846.c:1469:35: note: in expansion of macro 'do_div' 1469 | frame_length = do_div(link_freq, do_div(fps, HI846_LINE_LENGTH)); | ^~~~~~ >> include/asm-generic/div64.h:245:22: error: passing argument 1 of '__div64_32' from incompatible pointer type [-Werror=incompatible-pointer-types] 245 | __rem = __div64_32(&(n), __base); \ | ^~~~ | | | int * include/asm-generic/div64.h:226:21: note: in definition of macro 'do_div' 226 | uint32_t __base = (base); \ | ^~~~ drivers/media/i2c/hi846.c:1469:35: note: in expansion of macro 'do_div' 1469 | frame_length = do_div(link_freq, do_div(fps, HI846_LINE_LENGTH)); | ^~~~~~ include/asm-generic/div64.h:219:38: note: expected 'uint64_t *' {aka 'long long unsigned int *'} but argument is of type 'int *' 219 | extern uint32_t __div64_32(uint64_t *dividend, uint32_t divisor); | ~~~~~~~~~~^~~~~~~~ include/asm-generic/div64.h:228:28: warning: comparison of distinct pointer types lacks a cast 228 | (void)(((typeof((n)) *)0) == ((uint64_t *)0)); \ | ^~ drivers/media/i2c/hi846.c:1469:17: note: in expansion of macro 'do_div' 1469 | frame_length = do_div(link_freq, do_div(fps, HI846_LINE_LENGTH)); | ^~~~~~ cc1: some warnings being treated as errors vim +/__div64_32 +245 include/asm-generic/div64.h ^1da177e4c3f41 Linus Torvalds 2005-04-16 221 ^1da177e4c3f41 Linus Torvalds 2005-04-16 222 /* The unnecessary pointer compare is there ^1da177e4c3f41 Linus Torvalds 2005-04-16 223 * to check for type safety (n must be 64bit) ^1da177e4c3f41 Linus Torvalds 2005-04-16 224 */ ^1da177e4c3f41 Linus Torvalds 2005-04-16 225 # define do_div(n,base) ({ \ ^1da177e4c3f41 Linus Torvalds 2005-04-16 226 uint32_t __base = (base); \ ^1da177e4c3f41 Linus Torvalds 2005-04-16 227 uint32_t __rem; \ ^1da177e4c3f41 Linus Torvalds 2005-04-16 228 (void)(((typeof((n)) *)0) == ((uint64_t *)0)); \ 911918aa7ef6f8 Nicolas Pitre 2015-11-02 229 if (__builtin_constant_p(__base) && \ 911918aa7ef6f8 Nicolas Pitre 2015-11-02 230 is_power_of_2(__base)) { \ 911918aa7ef6f8 Nicolas Pitre 2015-11-02 231 __rem = (n) & (__base - 1); \ 911918aa7ef6f8 Nicolas Pitre 2015-11-02 232 (n) >>= ilog2(__base); \ 461a5e51060c93 Nicolas Pitre 2015-10-30 233 } else if (__div64_const32_is_OK && \ 461a5e51060c93 Nicolas Pitre 2015-10-30 234 __builtin_constant_p(__base) && \ 461a5e51060c93 Nicolas Pitre 2015-10-30 235 __base != 0) { \ 461a5e51060c93 Nicolas Pitre 2015-10-30 236 uint32_t __res_lo, __n_lo = (n); \ 461a5e51060c93 Nicolas Pitre 2015-10-30 237 (n) = __div64_const32(n, __base); \ 461a5e51060c93 Nicolas Pitre 2015-10-30 238 /* the remainder can be computed with 32-bit regs */ \ 461a5e51060c93 Nicolas Pitre 2015-10-30 239 __res_lo = (n); \ 461a5e51060c93 Nicolas Pitre 2015-10-30 240 __rem = __n_lo - __res_lo * __base; \ 911918aa7ef6f8 Nicolas Pitre 2015-11-02 241 } else if (likely(((n) >> 32) == 0)) { \ ^1da177e4c3f41 Linus Torvalds 2005-04-16 242 __rem = (uint32_t)(n) % __base; \ ^1da177e4c3f41 Linus Torvalds 2005-04-16 243 (n) = (uint32_t)(n) / __base; \ ^1da177e4c3f41 Linus Torvalds 2005-04-16 244 } else \ ^1da177e4c3f41 Linus Torvalds 2005-04-16 @245 __rem = __div64_32(&(n), __base); \ ^1da177e4c3f41 Linus Torvalds 2005-04-16 246 __rem; \ ^1da177e4c3f41 Linus Torvalds 2005-04-16 247 }) ^1da177e4c3f41 Linus Torvalds 2005-04-16 248 --- 0-DAY CI Kernel Test Service, Intel Corporation https://lists.01.org/hyperkitty/list/kbuild-all(a)lists.01.org [-- Attachment #2: config.gz --] [-- Type: application/gzip, Size: 59654 bytes --] ^ permalink raw reply [flat|nested] 14+ messages in thread
* [PATCH v3 4/5] arm64: defconfig: enable VIDEO_HI846 2021-05-31 12:07 [PATCH v3 0/5] Add support for the Hynix Hi-846 camera Martin Kepplinger ` (2 preceding siblings ...) 2021-05-31 12:07 ` [PATCH v3 3/5] media: i2c: add driver for the SK Hynix Hi-846 8M pixel camera Martin Kepplinger @ 2021-05-31 12:07 ` Martin Kepplinger 2021-05-31 12:07 ` [PATCH v3 5/5] Documentation: i2c-cardlist: add the Hynix hi846 sensor Martin Kepplinger 4 siblings, 0 replies; 14+ messages in thread From: Martin Kepplinger @ 2021-05-31 12:07 UTC (permalink / raw) To: pavel, krzysztof.kozlowski, laurent.pinchart, mchehab, paul.kocialkowski, robh, shawnx.tu Cc: devicetree, kernel, linux-kernel, linux-media, martin.kepplinger, phone-devel build the driver for the Hi-846 camera by default on arm64, where it's going to be used on at least the imx8mq-librem5 board. Signed-off-by: Martin Kepplinger <martin.kepplinger@puri.sm> --- arch/arm64/configs/defconfig | 1 + 1 file changed, 1 insertion(+) diff --git a/arch/arm64/configs/defconfig b/arch/arm64/configs/defconfig index 08c6f769df9a..3a5238c1f3b3 100644 --- a/arch/arm64/configs/defconfig +++ b/arch/arm64/configs/defconfig @@ -664,6 +664,7 @@ CONFIG_VIDEO_RENESAS_FCP=m CONFIG_VIDEO_RENESAS_VSP1=m CONFIG_SDR_PLATFORM_DRIVERS=y CONFIG_VIDEO_RCAR_DRIF=m +CONFIG_VIDEO_HI846=m CONFIG_VIDEO_IMX219=m CONFIG_VIDEO_OV5645=m CONFIG_VIDEO_QCOM_CAMSS=m -- 2.30.2 ^ permalink raw reply related [flat|nested] 14+ messages in thread
* [PATCH v3 5/5] Documentation: i2c-cardlist: add the Hynix hi846 sensor 2021-05-31 12:07 [PATCH v3 0/5] Add support for the Hynix Hi-846 camera Martin Kepplinger ` (3 preceding siblings ...) 2021-05-31 12:07 ` [PATCH v3 4/5] arm64: defconfig: enable VIDEO_HI846 Martin Kepplinger @ 2021-05-31 12:07 ` Martin Kepplinger 4 siblings, 0 replies; 14+ messages in thread From: Martin Kepplinger @ 2021-05-31 12:07 UTC (permalink / raw) To: pavel, krzysztof.kozlowski, laurent.pinchart, mchehab, paul.kocialkowski, robh, shawnx.tu Cc: devicetree, kernel, linux-kernel, linux-media, martin.kepplinger, phone-devel Add the SK Hynix Hi-846 8M Pixel CMOS image sensor to the i2c-cardlist. Signed-off-by: Martin Kepplinger <martin.kepplinger@puri.sm> --- Documentation/admin-guide/media/i2c-cardlist.rst | 1 + 1 file changed, 1 insertion(+) diff --git a/Documentation/admin-guide/media/i2c-cardlist.rst b/Documentation/admin-guide/media/i2c-cardlist.rst index e60d459d18a9..185e07a3da43 100644 --- a/Documentation/admin-guide/media/i2c-cardlist.rst +++ b/Documentation/admin-guide/media/i2c-cardlist.rst @@ -60,6 +60,7 @@ Driver Name ============ ========================================================== et8ek8 ET8EK8 camera sensor hi556 Hynix Hi-556 sensor +hi846 Hynix Hi-846 sensor imx214 Sony IMX214 sensor imx219 Sony IMX219 sensor imx258 Sony IMX258 sensor -- 2.30.2 ^ permalink raw reply related [flat|nested] 14+ messages in thread
end of thread, other threads:[~2021-06-02 19:24 UTC | newest] Thread overview: 14+ messages (download: mbox.gz / follow: Atom feed) -- links below jump to the message on this page -- 2021-05-31 12:07 [PATCH v3 0/5] Add support for the Hynix Hi-846 camera Martin Kepplinger 2021-05-31 12:07 ` [PATCH v3 1/5] dt-bindings: vendor-prefixes: Add SK Hynix Inc Martin Kepplinger 2021-06-02 19:23 ` Rob Herring 2021-05-31 12:07 ` [PATCH v3 2/5] dt-bindings: media: document SK Hynix Hi-846 MIPI CSI-2 8M pixel sensor Martin Kepplinger 2021-05-31 23:13 ` Laurent Pinchart 2021-05-31 23:24 ` Laurent Pinchart 2021-05-31 12:07 ` [PATCH v3 3/5] media: i2c: add driver for the SK Hynix Hi-846 8M pixel camera Martin Kepplinger 2021-06-01 0:14 ` Laurent Pinchart 2021-06-02 12:00 ` Martin Kepplinger 2021-06-02 17:57 ` Laurent Pinchart 2021-06-01 6:50 ` kernel test robot 2021-06-01 6:50 ` kernel test robot 2021-05-31 12:07 ` [PATCH v3 4/5] arm64: defconfig: enable VIDEO_HI846 Martin Kepplinger 2021-05-31 12:07 ` [PATCH v3 5/5] Documentation: i2c-cardlist: add the Hynix hi846 sensor Martin Kepplinger
This is an external index of several public inboxes, see mirroring instructions on how to clone and mirror all data and code used by this external index.