Galaxycore GC5035 sensor driver
Subsystems (3)
v4 cover Galaxycore GC5035 sensor driver
Hi everyone,
This series adds YAML DT binding and V4L2 sub-device driver for Galaxycore GC5035 5-megapixel 10-bit Bayer CMOS 1/4" sensor, which has a two-lane MIPI CSI-2 data interface and uses the I2C bus for control
The initial version supports the following features:
- Manual exposure, analog and digital gain control
- Vertical blanking interval control
- Test pattern generator (color bars)
- Media controller support
- Runtime PM support
- Support operating modes:
o 2592x1944 at 30fps,
o 1296x972 at 30fps,
o 1280x720 at 60fps.
A separate patch in the series adds support for loading manufacture-time configuration from the sensor OTP, which currently includes:
- register patch table,
- DPC table.
This is based on Hao He's and Xingyu Wu's v3 series that partially reached the maling lists:
- patch 1/3 - equivalent of patch 1/4 of this seres:
https://patchwork.ozlabs.org/project/devicetree-bindings/patch/[email protected]/
- patch 3/3 - equivalent of patches 3/4 + 4/4 of this series:
https://patchwork.ozlabs.org/project/devicetree-bindings/patch/[email protected]/
Patch 2/3 that adds DT bindings was missing so I recreated it from scratch on my own.
Changes from v3:
- Require and handle clock-frequency and link-frequencies device properties.
- Separate the driver patch into one for base functionality and another for OTP handling.
- Do not perform OTP initialization on driver probe, since it's a costly operation. Instead do it at first streaming time.
- Fix power sequencing to match the hardware specification.
- Set system PM ops.
- Various stylistic changes and general clean-up.
- Add myself as a maintainer.
Hao He (3):
dt-bindings: Add a vendor prefix for Galaxycore Inc.
media: i2c: Add a driver for the Galaxycore GC5035 sensor
media: i2c: gc5035: Add OTP configuration handling
Tomasz Figa (1):
media: dt-bindings: media: i2c: Add bindings for GC5035
.../devicetree/bindings/media/i2c/gc5035.yaml | 142 ++ .../devicetree/bindings/vendor-prefixes.yaml | 2 + MAINTAINERS | 7 + drivers/media/i2c/Kconfig | 13 + drivers/media/i2c/Makefile | 1 + drivers/media/i2c/gc5035.c | 1972 +++++++++++++++++ 6 files changed, 2137 insertions(+) create mode 100644 Documentation/devicetree/bindings/media/i2c/gc5035.yaml create mode 100644 drivers/media/i2c/gc5035.c
Signature · 1 line
2.28.0.402.g5ffc5be6b7-goog
PATCH v4 1/4 dt-bindings: Add a vendor prefix for Galaxycore Inc.
From: Hao He <[email protected]>
Add a vendor prefix for Galaxycore Inc. as a prerequisite for adding bindings for a new imaging sensor.
--- Documentation/devicetree/bindings/vendor-prefixes.yaml | 2 ++ 1 file changed, 2 insertions(+)
Documentation/devicetree/bindings/vendor-prefixes.yaml +2 -0
@@ -385,6 +385,8 @@ patternProperties: description: Freescale Semiconductor "^fujitsu,.*": description: Fujitsu Ltd. + "^galaxycore,.*": + description: GalaxyCore, Inc. "^gardena,.*": description: GARDENA GmbH "^gateworks,.*":
Signature · 1 line
2.28.0.402.g5ffc5be6b7-goog
Re: [PATCH v4 1/4] dt-bindings: Add a vendor prefix for Galaxycore Inc.
Quoted 5 lines · Tomasz Figa
From: Hao He <[email protected]>
Add a vendor prefix for Galaxycore Inc. as a prerequisite for adding bindings for a new imaging sensor.
Quoted 7 lines
Signed-off-by Hao He <[email protected]>Signed-off-by Xingyu Wu <[email protected]>Signed-off-by Tomasz Figa <[email protected]>--- Documentation/devicetree/bindings/vendor-prefixes.yaml | 2 ++ 1 file changed, 2 insertions(+)
PATCH v4 2/4 media: dt-bindings: media: i2c: Add bindings for GC5035
In reply to Tomasz FigaAdd YAML device tree bindings for Galaxycore Inc. GC5035 imaging sensor.
--- .../devicetree/bindings/media/i2c/gc5035.yaml | 142 ++++++++++++++++++ 1 file changed, 142 insertions(+) create mode 100644 Documentation/devicetree/bindings/media/i2c/gc5035.yaml
Documentation/devicetree/bindings/media/i2c/gc5035.yaml new file +142 -0
@@ -0,0 +1,142 @@ +# SPDX-License-Identifier: (GPL-2.0 OR BSD-2-Clause) +# Copyright (c) 2019 MediaTek Inc. +%YAML 1.2 +--- +$id: http://devicetree.org/schemas/media/i2c/gc5035.yaml +$schema: http://devicetree.org/meta-schemas/core.yaml# + +title: Galaxycore Inc. GC5035 CMOS Sensor Device Tree Bindings + +maintainers: + - Tomasz Figa <[email protected]> + +description: |- + The Galaxycore Inc. GC5035 is a 5 megapixel, 1/5 inch CMOS 10-bit Bayer image + sensor that delivers 2592x1944 at 30fps. This chip is programmable through + an I2C interface. The image output is available via a MIPI CSI-2 interface. + +properties: + compatible: + const: galaxycore,gc5035 + + reg: + maxItems: 1 + + clocks: + maxItems: 1 + + clock-names: + description: + Input clock for the sensor. + items: + - const: inclk + + clock-frequency: + description: + Frequency of the inclk clock in Hz. + + iovdd-supply: + description: + Regulator driving the I/O power rail. + + avdd28-supply: + description: + Regulator driving the analog power rail. + + dvdd12-supply: + description: + Regulator driving the digital power rail. + + resetb-gpios: + description: + The GPIO pin that drives the RESETB signal, controlling sensor reset. + The RESETB signal must be driven low to activate the reset, so the + GPIO_ACTIVE_LOW flag should be given by default. + + pwdn-gpios: + description: + The GPIO pin that drives the PWDN signal, controlling sensor power-down + mode. The PWDN signal must be driven low to activate the power-down + mode, so the GPIO_ACTIVE_LOW flag should be given by default. + + port: + type: object + additionalProperties: false + description: + A node containing an output port node with an endpoint definition + as documented in + Documentation/devicetree/bindings/media/video-interfaces.txt + + properties: + endpoint: + type: object + additionalProperties: false + + properties: + data-lanes: + items: + - const: 1 + - const: 2 + + link-frequencies: true + remote-endpoint: true + + required: + - data-lanes + - link-frequencies + - remote-endpoint + + required: + - endpoint + +required: + - compatible + - reg + - clocks + - clock-names + - clock-frequency + - iovdd-supply + - avdd28-supply + - dvdd12-supply + - resetb-gpios + - pwdn-gpios + - port + +additionalProperties: false + +examples: + - | + #include <dt-bindings/gpio/gpio.h> + + i2c { + #address-cells = <1>; + #size-cells = <0>; + + gc5035: camera@10 { + compatible = "galaxycore,gc5035"; + reg = <0x10>; + + reset-gpios = <&pio 111 GPIO_ACTIVE_LOW>; + pwdn-gpios = <&pio 112 GPIO_ACTIVE_LOW>; + pinctrl-names = "default"; + pinctrl-0 = <&clk_24m_cam>; + + clocks = <&cam_osc>; + clock-names = "inclk"; + clock-frequency = <24000000>; + + avdd28-supply = <&mt6358_vcama2_reg>; + dvdd12-supply = <&mt6358_vcamd_reg>; + iovdd-supply = <&mt6358_vcamio_reg>; + + port { + wcam_out: endpoint { + remote-endpoint = <&mipi_in_wcam>; + data-lanes = <1 2>; + link-frequencies = /bits/ 64 <438000000>; + }; + }; + }; + }; +... +
Signature · 1 line
2.28.0.402.g5ffc5be6b7-goog
Re: [PATCH v4 2/4] media: dt-bindings: media: i2c: Add bindings for GC5035
Self-review,
Quoted 15 lines · Tomasz Figa
Add YAML device tree bindings for Galaxycore Inc. GC5035 imaging sensor.
Signed-off-by Tomasz Figa <[email protected]>--- .../devicetree/bindings/media/i2c/gc5035.yaml | 142 ++++++++++++++++++ 1 file changed, 142 insertions(+) create mode 100644 Documentation/devicetree/bindings/media/i2c/gc5035.yamlDocumentation/devicetree/bindings/media/i2c/gc5035.yaml new file +0
-0
Documentation/devicetree/bindings/media/i2c/gc5035.yaml line 2
Quoted 2 lines
Documentation/devicetree/bindings/media/i2c/gc5035.yaml new file +2
-0@@ -0,0 +1,142 @@ +# SPDX-License-Identifier: (GPL-2.0 OR BSD-2-Clause) +# Copyright (c) 2019 MediaTek Inc.
Copyright 2020 Google LLC.
Quoted 20 lines
Documentation/devicetree/bindings/media/i2c/gc5035.yaml new file +20
-0+%YAML 1.2 +--- +$id: http://devicetree.org/schemas/media/i2c/gc5035.yaml +$schema: http://devicetree.org/meta-schemas/core.yaml# + +title: Galaxycore Inc. GC5035 CMOS Sensor Device Tree Bindings + +maintainers: + - Tomasz Figa <[email protected]> + +description: |- + The Galaxycore Inc. GC5035 is a 5 megapixel, 1/5 inch CMOS 10-bit Bayer image + sensor that delivers 2592x1944 at 30fps. This chip is programmable through + an I2C interface. The image output is available via a MIPI CSI-2 interface. + +properties: + compatible: + const: galaxycore,gc5035 + + reg:
Documentation/devicetree/bindings/media/i2c/gc5035.yaml line 32
Quoted 10 lines
Documentation/devicetree/bindings/media/i2c/gc5035.yaml new file +10
-0+ maxItems: 1 + + clocks: + maxItems: 1 + + clock-names: + description: + Input clock for the sensor. + items: + - const: inclk
Typo: mclk.
Documentation/devicetree/bindings/media/i2c/gc5035.yaml line 36
Quoted 4 lines
Documentation/devicetree/bindings/media/i2c/gc5035.yaml new file +4
-0+ + clock-frequency: + description: + Frequency of the inclk clock in Hz.
mclk
Quoted 79 lines
Documentation/devicetree/bindings/media/i2c/gc5035.yaml new file +79
-0+ + iovdd-supply: + description: + Regulator driving the I/O power rail. + + avdd28-supply: + description: + Regulator driving the analog power rail. + + dvdd12-supply: + description: + Regulator driving the digital power rail. + + resetb-gpios: + description: + The GPIO pin that drives the RESETB signal, controlling sensor reset. + The RESETB signal must be driven low to activate the reset, so the + GPIO_ACTIVE_LOW flag should be given by default. + + pwdn-gpios: + description: + The GPIO pin that drives the PWDN signal, controlling sensor power-down + mode. The PWDN signal must be driven low to activate the power-down + mode, so the GPIO_ACTIVE_LOW flag should be given by default. + + port: + type: object + additionalProperties: false + description: + A node containing an output port node with an endpoint definition + as documented in + Documentation/devicetree/bindings/media/video-interfaces.txt + + properties: + endpoint: + type: object + additionalProperties: false + + properties: + data-lanes: + items: + - const: 1 + - const: 2 + + link-frequencies: true + remote-endpoint: true + + required: + - data-lanes + - link-frequencies + - remote-endpoint + + required: + - endpoint + +required: + - compatible + - reg + - clocks + - clock-names + - clock-frequency + - iovdd-supply + - avdd28-supply + - dvdd12-supply + - resetb-gpios + - pwdn-gpios + - port + +additionalProperties: false + +examples: + - | + #include <dt-bindings/gpio/gpio.h> + + i2c { + #address-cells = <1>; + #size-cells = <0>; + + gc5035: camera@10 {
Documentation/devicetree/bindings/media/i2c/gc5035.yaml line 125
Quoted 10 lines
Documentation/devicetree/bindings/media/i2c/gc5035.yaml new file +10
-0+ compatible = "galaxycore,gc5035"; + reg = <0x10>; + + reset-gpios = <&pio 111 GPIO_ACTIVE_LOW>; + pwdn-gpios = <&pio 112 GPIO_ACTIVE_LOW>; + pinctrl-names = "default"; + pinctrl-0 = <&clk_24m_cam>; + + clocks = <&cam_osc>; + clock-names = "inclk";
mclk
Best regards,
Tomasz
Rob Herring
maintainerRe: [PATCH v4 2/4] media: dt-bindings: media: i2c: Add bindings for GC5035
In reply to Tomasz FigaQuoted 8 lines · Tomasz Figa
Add YAML device tree bindings for Galaxycore Inc. GC5035 imaging sensor.
Signed-off-by Tomasz Figa <[email protected]>--- .../devicetree/bindings/media/i2c/gc5035.yaml | 142 ++++++++++++++++++ 1 file changed, 142 insertions(+) create mode 100644 Documentation/devicetree/bindings/media/i2c/gc5035.yaml
My bot found errors running 'make dt_binding_check' on your patch:
/builds/robherring/linux-dt-review/Documentation/devicetree/bindings/media/i2c/gc5035.yaml: $id: 'http://devicetree.org/schemas/media/i2c/gc5035.yaml' does not match 'http://devicetree.org/schemas/.*\\.yaml#' /builds/robherring/linux-dt-review/Documentation/devicetree/bindings/media/i2c/gc5035.yaml: ignoring, error in schema: $id
warning: no schema found in file: ./Documentation/devicetree/bindings/media/i2c/gc5035.yaml
See https://patchwork.ozlabs.org/patch/1356170
If you already ran 'make dt_binding_check' and didn't see the above error(s), then make sure dt-schema is up to date:
pip3 install git+https://github.com/devicetree-org/dt-schema.git@master --upgrade
Please check and re-submit.
PATCH v4 3/4 media: i2c: Add a driver for the Galaxycore GC5035 sensor
In reply to Tomasz FigaFrom: Hao He <[email protected]>
Galaxycore GC5035 is a 5 Mpix 10-bit Bayer sensor with a 2-lane MIPI CSI-2 data and I2C control interfaces.
For the iniitial version support 2592x1944@30fps, 1296x972@30fps and 1280x720@60fps modes, assuming link frequency of 438 MHz and external clock of 24 MHz.
--- MAINTAINERS | 7 + drivers/media/i2c/Kconfig | 13 + drivers/media/i2c/Makefile | 1 + drivers/media/i2c/gc5035.c | 1494 ++++++++++++++++++++++++++++++++++++ 4 files changed, 1515 insertions(+) create mode 100644 drivers/media/i2c/gc5035.c
MAINTAINERS +7 -0
@@ -7249,6 +7249,13 @@ F: kernel/futex.c F: tools/perf/bench/futex* F: tools/testing/selftests/futex/ +GALAXYCORE GC5035 SENSOR DRIVER +M: Tomasz Figa <[email protected]> +L: [email protected] +S: Maintained +T: git git://linuxtv.org/media_tree.git +F: drivers/media/i2c/gc5035.c + GATEWORKS SYSTEM CONTROLLER (GSC) DRIVER M: Tim Harvey <[email protected]> M: Robert Jones <[email protected]>
drivers/media/i2c/Kconfig +13 -0
@@ -725,6 +725,19 @@ config VIDEO_APTINA_PLL config VIDEO_SMIAPP_PLL tristate +config VIDEO_GC5035 + tristate "Galaxycore GC5035 sensor support" + depends on I2C && VIDEO_V4L2 + select MEDIA_CONTROLLER + select V4L2_FWNODE + select VIDEO_V4L2_SUBDEV_API + help + This is a Video4Linux2 sensor driver for the Galaxycore + GC5035 imaging sensor. + + To compile this driver as a module, choose M here: the + module will be called gc5035. + config VIDEO_HI556 tristate "Hynix Hi-556 sensor support" depends on I2C && VIDEO_V4L2
drivers/media/i2c/Makefile +1 -0
@@ -123,5 +123,6 @@ obj-$(CONFIG_VIDEO_MAX9286) += max9286.o rdacm20-camera_module-objs := rdacm20.o max9271.o obj-$(CONFIG_VIDEO_RDACM20) += rdacm20-camera_module.o obj-$(CONFIG_VIDEO_ST_MIPID02) += st-mipid02.o +obj-$(CONFIG_VIDEO_GC5035) += gc5035.o obj-$(CONFIG_SDR_MAX2175) += max2175.o
drivers/media/i2c/gc5035.c new file +1494 -0
1,494 lines not on this page · raw message
Signature · 1 line
2.28.0.402.g5ffc5be6b7-goog
PATCH v4 4/4 media: i2c: gc5035: Add OTP configuration handling
In reply to Tomasz FigaFrom: Hao He <[email protected]>
The sensor OTP holds values for various configuration registers deteremined at manufacturing time and dead pixel correction tables. Add code to load both from the OTP and initialize the sensor appropriately.
--- drivers/media/i2c/gc5035.c | 478 +++++++++++++++++++++++++++++++++++++ 1 file changed, 478 insertions(+)
drivers/media/i2c/gc5035.c +478 -0
@@ -81,6 +81,57 @@#define GC5035_TEST_PATTERN_ENABLE 0x11#define GC5035_TEST_PATTERN_DISABLE 0x10 +/* Page 2 registers */ + +/* OTP access registers */ +#define GC5035_REG_OTP_MODE 0xf3 +#define GC5035_OTP_PRE_READ 0x20 +#define GC5035_OTP_READ_MODE 0x12 +#define GC5035_OTP_READ_DONE 0x00 +#define GC5035_REG_OTP_DATA 0x6c +#define GC5035_REG_OTP_ACCESS_ADDR_H 0x69 +#define GC5035_REG_OTP_ACCESS_ADDR_L 0x6a +#define GC5035_OTP_ACCESS_ADDR_H_MASK 0x1f +#define GC5035_OTP_ADDR_MASK 0x1fff +#define GC5035_OTP_ADDR_SHIFT 3 +#define GC5035_REG_DD_TOTALNUM_H 0x01 +#define GC5035_REG_DD_TOTALNUM_L 0x02 +#define GC5035_DD_TOTALNUM_H_MASK 0x07 +#define GC5035_REG_DD_LOAD_STATUS 0x06 +#define GC5035_OTP_BIT_LOAD BIT(0) + +/* OTP-related definitions */ + +#define GC5035_OTP_ID_SIZE 9 +#define GC5035_OTP_ID_DATA_OFFSET 0x0020 +#define GC5035_OTP_DATA_LENGTH 1024 + +/* OTP DPC parameters */ +#define GC5035_OTP_DPC_FLAG_OFFSET 0x0068 +#define GC5035_OTP_DPC_FLAG_MASK 0x03 +#define GC5035_OTP_FLAG_EMPTY 0x00 +#define GC5035_OTP_FLAG_VALID 0x01 +#define GC5035_OTP_DPC_TOTAL_NUMBER_OFFSET 0x0070 +#define GC5035_OTP_DPC_ERROR_NUMBER_OFFSET 0x0078 + +/* OTP register parameters */ +#define GC5035_OTP_REG_FLAG_OFFSET 0x0880 +#define GC5035_OTP_REG_DATA_OFFSET 0x0888 +#define GC5035_OTP_REG_ADDR_OFFSET 1 +#define GC5035_OTP_REG_VAL_OFFSET 2 +#define GC5035_OTP_PAGE_FLAG_OFFSET 3 +#define GC5035_OTP_PER_PAGE_SIZE 4 +#define GC5035_OTP_REG_PAGE_MASK 0x07 +#define GC5035_OTP_REG_MAX_GROUP 5 +#define GC5035_OTP_REG_BYTE_PER_GROUP 5 +#define GC5035_OTP_REG_PER_GROUP 2 +#define GC5035_OTP_REG_BYTE_PER_REG 2 +#define GC5035_OTP_REG_DATA_SIZE 25 +#define GC5035_OTP_REG_SIZE 10 + +#define GC5035_DD_DELAY_US (10 * 1000) +#define GC5035_DD_TIMEOUT_US (100 * 1000) +static const char *const gc5035_supplies[] = {/* * Requested separately due to power sequencing needs:
@@ -95,6 +146,21 @@ struct gc5035_regval {u8 val; }; +struct gc5035_reg { +u8 page; +struct gc5035_regval regval; +}; + +struct gc5035_otp_regs { +unsigned int num_regs; +struct gc5035_reg regs[GC5035_OTP_REG_SIZE ]; +}; + +struct gc5035_dpc { +bool valid; +unsigned int total_num; +}; +struct gc5035_mode {u32 width;u32 height;
@@ -122,6 +188,11 @@ struct gc5035 {struct v4l2_ctrl *hblank;struct v4l2_ctrl *vblank; +bool otp_read; +u8 otp_id[GC5035_OTP_ID_SIZE ]; +struct gc5035_dpc dpc; +struct gc5035_otp_regs otp_regs; +/* * Serialize control access, get/set format, get selection * and start streaming.
@@ -136,6 +207,69 @@ static inline struct gc5035 *to_gc5035(struct v4l2_subdev *sd) return container_of(sd, struct gc5035, subdev); } +static const struct gc5035_regval gc5035_otp_init_regs[] = { + {0xfc ,0x01 }, + {0xf4 ,0x40 }, + {0xf5 ,0xe9 }, + {0xf6 ,0x14 }, + {0xf8 ,0x49 }, + {0xf9 ,0x82 }, + {0xfa ,0x00 }, + {0xfc ,0x81 }, + {0xfe ,0x00 }, + {0x36 ,0x01 }, + {0xd3 ,0x87 }, + {0x36 ,0x00 }, + {0x33 ,0x00 }, + {0xf7 ,0x01 }, + {0xfc ,0x8e }, + {0xfe ,0x00 }, + {0xee ,0x30 }, + {0xfa ,0x10 }, + {0xf5 ,0xe9 }, + {0xfe ,0x02 }, + {0x67 ,0xc0 }, + {0x59 ,0x3f }, + {0x55 ,0x84 }, + {0x65 ,0x80 }, + {0x66 ,0x03 }, + {0xfe ,0x00 }, +}; + +static const struct gc5035_regval gc5035_otp_exit_regs[] = { + {0xfe ,0x02 }, + {0x67 ,0x00 }, + {0xfe ,0x00 }, + {0xfa ,0x00 }, +}; + +static const struct gc5035_regval gc5035_dd_auto_load_regs[] = { + {0xfe ,0x02 }, + {0xbe ,0x00 }, + {0xa9 ,0x01 }, + {0x09 ,0x33 }, +}; + +static const struct gc5035_regval gc5035_otp_dd_regs[] = { + {0x03 ,0x00 }, + {0x04 ,0x80 }, + {0x95 ,0x0a }, + {0x96 ,0x30 }, + {0x97 ,0x0a }, + {0x98 ,0x32 }, + {0x99 ,0x07 }, + {0x9a ,0xa9 }, + {0xf3 ,0x80 }, +}; + +static const struct gc5035_regval gc5035_otp_dd_enable_regs[] = { + {0xbe ,0x01 }, + {0x09 ,0x00 }, + {0xfe ,0x01 }, + {0x80 ,0x02 }, + {0xfe ,0x00 }, +}; +/* * Xclk 24Mhz * Pclk 87.6Mhz
@@ -763,6 +897,346 @@ static int gc5035_read_reg(struct gc5035 *gc5035, u8 reg, u8 *val)return 0 ; } +static int gc5035_otp_read_data (struct gc5035 *gc5035,u16 bit_addr,u8 *data, +size_t length) +{ +size_t i; +int ret; + +if (WARN_ON (bit_addr %8 )) +return -EINVAL ; + +if (WARN_ON (bit_addr /8 + length >GC5035_OTP_DATA_LENGTH )) +return -EINVAL ; + + ret =gc5035_write_reg (gc5035,GC5035_PAGE_REG ,2 ); +if (ret) +return ret; + + ret =gc5035_write_reg (gc5035,GC5035_REG_OTP_ACCESS_ADDR_H , + (bit_addr >>8 ) & +GC5035_OTP_ACCESS_ADDR_H_MASK ); +if (ret) +return ret; + + ret =gc5035_write_reg (gc5035,GC5035_REG_OTP_ACCESS_ADDR_L , + bit_addr &0xff ); +if (ret) +return ret; + + ret =gc5035_write_reg (gc5035,GC5035_REG_OTP_MODE , +GC5035_OTP_PRE_READ ); +if (ret) + goto out_read_done; + + ret =gc5035_write_reg (gc5035,GC5035_REG_OTP_MODE , +GC5035_OTP_READ_MODE ); +if (ret) + goto out_read_done; + +for (i =0 ; i < length; i++) { + ret =gc5035_read_reg (gc5035,GC5035_REG_OTP_DATA , &data[i]); +if (ret) + goto out_read_done; + } + +out_read_done: +gc5035_write_reg (gc5035,GC5035_REG_OTP_MODE ,GC5035_OTP_READ_DONE ); + +return ret; +} + +static int gc5035_read_otp_regs (struct gc5035 *gc5035) +{ +struct device *dev = &gc5035->client->dev; +struct gc5035_otp_regs *otp_regs = &gc5035->otp_regs; +u8 regs[GC5035_OTP_REG_DATA_SIZE ] = {0 }; +unsigned int i, j; +u8 flag; +int ret; + + ret =gc5035_otp_read_data (gc5035,GC5035_OTP_REG_FLAG_OFFSET , + &flag,1 ); +if (ret) { +dev_err (dev,"failed to read otp reg flag\n" ); +return ret; + } + +dev_dbg (dev,"register update flag = 0x%x\n" , flag); + + gc5035->otp_regs.num_regs =0 ; +if (flag !=GC5035_OTP_FLAG_VALID ) +return 0 ; + + ret =gc5035_otp_read_data (gc5035,GC5035_OTP_REG_DATA_OFFSET , + regs,sizeof (regs)); +if (ret) { +dev_err (dev,"failed to read otp reg data\n" ); +return ret; + } + +for (i =0 ; i <GC5035_OTP_REG_MAX_GROUP ; i++) { +unsigned int base_group = i *GC5035_OTP_REG_BYTE_PER_GROUP ; + +for (j =0 ; j <GC5035_OTP_REG_PER_GROUP ; j++) { +struct gc5035_reg *reg; + +if (!(regs[base_group] & +BIT ((GC5035_OTP_PER_PAGE_SIZE * j + +GC5035_OTP_PAGE_FLAG_OFFSET )))) +continue ; + + reg = &otp_regs->regs[otp_regs->num_regs++]; + reg->page = (regs[base_group] >> + (GC5035_OTP_PER_PAGE_SIZE * j)) & +GC5035_OTP_REG_PAGE_MASK ; + reg->regval.addr = regs[base_group + j * +GC5035_OTP_REG_BYTE_PER_REG + +GC5035_OTP_REG_ADDR_OFFSET ]; + reg->regval.val = regs[base_group + j * +GC5035_OTP_REG_BYTE_PER_REG + +GC5035_OTP_REG_VAL_OFFSET ]; + } + } + +return 0 ; +} + +static int gc5035_read_dpc (struct gc5035 *gc5035) +{ +struct device *dev = &gc5035->client->dev; +struct gc5035_dpc *dpc = &gc5035->dpc; +u8 dpc_flag =0 ; +u8 error_number =0 ; +u8 total_number =0 ; +int ret; + + ret =gc5035_otp_read_data (gc5035,GC5035_OTP_DPC_FLAG_OFFSET , + &dpc_flag,1 ); +if (ret) { +dev_err (dev,"failed to read dpc flag\n" ); +return ret; + } + +dev_dbg (dev,"dpc flag = 0x%x\n" , dpc_flag); + + dpc->valid = false; + +switch (dpc_flag &GC5035_OTP_DPC_FLAG_MASK ) { +case GC5035_OTP_FLAG_EMPTY : +dev_dbg (dev,"dpc info is empty!!\n" ); +break ; + +case GC5035_OTP_FLAG_VALID : +dev_dbg (dev,"dpc info is valid!\n" ); + ret =gc5035_otp_read_data (gc5035, +GC5035_OTP_DPC_TOTAL_NUMBER_OFFSET , + &total_number,1 ); +if (ret) { +dev_err (dev,"failed to read dpc total number\n" ); +return ret; + } + + ret =gc5035_otp_read_data (gc5035, +GC5035_OTP_DPC_ERROR_NUMBER_OFFSET , + &error_number,1 ); +if (ret) { +dev_err (dev,"failed to read dpc error number\n" ); +return ret; + } + + dpc->total_num = total_number + error_number; + dpc->valid = true; +dev_dbg (dev,"total_num = %d\n" , dpc->total_num); +break ; + +default : +break ; + } + +return ret; +} + +static int gc5035_otp_read_sensor_info (struct gc5035 *gc5035) +{ +int ret; + + ret =gc5035_read_dpc (gc5035); +if (ret) +return ret; + +return gc5035_read_otp_regs (gc5035); +} + +static int gc5035_check_dd_load_status (struct gc5035 *gc5035) +{ +u8 status; +int ret; + + ret =gc5035_read_reg (gc5035,GC5035_REG_DD_LOAD_STATUS , &status); +if (ret) +return ret; + +if (status &GC5035_OTP_BIT_LOAD ) +return status; +else +return 0 ; +} + +static int gc5035_otp_update_dd (struct gc5035 *gc5035) +{ +struct device *dev = &gc5035->client->dev; +struct gc5035_dpc *dpc = &gc5035->dpc; +int val, ret; + +if (!dpc->valid) { +dev_dbg (dev,"DPC table invalid, not updating DD.\n" ); +return 0 ; + } + +dev_dbg (dev,"DD auto load start\n" ); + + ret =gc5035_write_array (gc5035, gc5035_dd_auto_load_regs, +ARRAY_SIZE (gc5035_dd_auto_load_regs)); +if (ret) { +dev_err (dev,"failed to write dd auto load reg\n" ); +return ret; + } + + ret =gc5035_write_reg (gc5035,GC5035_REG_DD_TOTALNUM_H , + (dpc->total_num >>8 ) & +GC5035_DD_TOTALNUM_H_MASK ); +if (ret) +return ret; + + ret =gc5035_write_reg (gc5035,GC5035_REG_DD_TOTALNUM_L , + dpc->total_num &0xff ); +if (ret) +return ret; + + ret =gc5035_write_array (gc5035, gc5035_otp_dd_regs, +ARRAY_SIZE (gc5035_otp_dd_regs)); +if (ret) +return ret; + +/* Wait for DD to finish loading automatically */ + ret =readx_poll_timeout (gc5035_check_dd_load_status, gc5035, + val, val <=0 ,GC5035_DD_DELAY_US , +GC5035_DD_TIMEOUT_US ); +if (ret <0 ) { +dev_err (dev,"DD load timeout\n" ); +return -EFAULT ; + } +if (val <0 ) { +dev_err (dev,"DD load failure\n" ); +return val; + } + + ret =gc5035_write_array (gc5035, gc5035_otp_dd_enable_regs, +ARRAY_SIZE (gc5035_otp_dd_enable_regs)); +if (ret) +return ret; + +return 0 ; +} + +static int gc5035_otp_update_regs (struct gc5035 *gc5035) +{ +struct device *dev = &gc5035->client->dev; +struct gc5035_otp_regs *otp_regs = &gc5035->otp_regs; +unsigned int i; +int ret; + +dev_dbg (dev,"reg count = %d\n" , otp_regs->num_regs); + +for (i =0 ; i < otp_regs->num_regs; i++) { + ret =gc5035_write_reg (gc5035,GC5035_PAGE_REG , + otp_regs->regs[i].page); +if (ret) +return ret; + + ret =gc5035_write_reg (gc5035, + otp_regs->regs[i].regval.addr, + otp_regs->regs[i].regval.val); +if (ret) +return ret; + } + +return 0 ; +} + +static int gc5035_otp_update (struct gc5035 *gc5035) +{ +struct device *dev = &gc5035->client->dev; +int ret; + + ret =gc5035_otp_update_dd (gc5035); +if (ret) { +dev_err (dev,"failed to update otp dd\n" ); +return ret; + } + + ret =gc5035_otp_update_regs (gc5035); +if (ret) { +dev_err (dev,"failed to update otp regs\n" ); +return ret; + } + +return ret; +} + +static int gc5035_set_otp_config (struct gc5035 *gc5035) +{ +struct device *dev = &gc5035->client->dev; +u8 otp_id[GC5035_OTP_ID_SIZE ]; +int ret; + + ret =gc5035_write_array (gc5035, gc5035_otp_init_regs, +ARRAY_SIZE (gc5035_otp_init_regs)); +if (ret) { +dev_err (dev,"failed to write otp init reg\n" ); +return ret; + } + + ret =gc5035_otp_read_data (gc5035,GC5035_OTP_ID_DATA_OFFSET , + &otp_id[0 ],GC5035_OTP_ID_SIZE ); +if (ret) { +dev_err (dev,"failed to read otp id\n" ); + goto out_otp_exit; + } + +if (!gc5035->otp_read ||memcmp (gc5035->otp_id, otp_id,sizeof (otp_id))) { +dev_dbg (dev,"reading OTP configuration\n" ); + +memset (&gc5035->otp_regs,0 ,sizeof (gc5035->otp_regs)); +memset (&gc5035->dpc,0 ,sizeof (gc5035->dpc)); + +memcpy (gc5035->otp_id, otp_id,sizeof (gc5035->otp_id)); + + ret =gc5035_otp_read_sensor_info (gc5035); +if (ret <0 ) { +dev_err (dev,"failed to read otp info\n" ); + goto out_otp_exit; + } + + gc5035->otp_read = true; + } + + ret =gc5035_otp_update (gc5035); +if (ret <0 ) +return ret; + +out_otp_exit: + ret =gc5035_write_array (gc5035, gc5035_otp_exit_regs, +ARRAY_SIZE (gc5035_otp_exit_regs)); +if (ret) { +dev_err (dev,"failed to write otp exit reg\n" ); +return ret; + } + +return ret; +} +static int gc5035_set_fmt (struct v4l2_subdev *sd,struct v4l2_subdev_pad_config *cfg,struct v4l2_subdev_format *fmt)
@@ -859,6 +1333,10 @@ static int __gc5035_start_stream(struct gc5035 *gc5035)if (ret)return ret; + ret =gc5035_set_otp_config (gc5035); +if (ret) +return ret; + ret =gc5035_write_array (gc5035, gc5035->cur_mode->reg_list, gc5035->cur_mode->num_regs);if (ret)
Signature · 1 line
2.28.0.402.g5ffc5be6b7-goog
Sakari Ailus
maintainerRe: [PATCH v4 4/4] media: i2c: gc5035: Add OTP configuration handling
Hi Tomasz,
Thanks for the patch.
Quoted 476 lines · Tomasz Figa
From: Hao He <[email protected]>
The sensor OTP holds values for various configuration registers deteremined at manufacturing time and dead pixel correction tables. Add code to load both from the OTP and initialize the sensor appropriately.
Signed-off-by Hao He <[email protected]>Signed-off-by Xingyu Wu <[email protected]>Signed-off-by Tomasz Figa <[email protected]>--- drivers/media/i2c/gc5035.c | 478 +++++++++++++++++++++++++++++++++++++ 1 file changed, 478 insertions(+)drivers/media/i2c/gc5035.c +427
-0@@ -81,6 +81,57 @@#define GC5035_TEST_PATTERN_ENABLE 0x11#define GC5035_TEST_PATTERN_DISABLE 0x10 +/* Page 2 registers */ + +/* OTP access registers */ +#define GC5035_REG_OTP_MODE 0xf3 +#define GC5035_OTP_PRE_READ 0x20 +#define GC5035_OTP_READ_MODE 0x12 +#define GC5035_OTP_READ_DONE 0x00 +#define GC5035_REG_OTP_DATA 0x6c +#define GC5035_REG_OTP_ACCESS_ADDR_H 0x69 +#define GC5035_REG_OTP_ACCESS_ADDR_L 0x6a +#define GC5035_OTP_ACCESS_ADDR_H_MASK 0x1f +#define GC5035_OTP_ADDR_MASK 0x1fff +#define GC5035_OTP_ADDR_SHIFT 3 +#define GC5035_REG_DD_TOTALNUM_H 0x01 +#define GC5035_REG_DD_TOTALNUM_L 0x02 +#define GC5035_DD_TOTALNUM_H_MASK 0x07 +#define GC5035_REG_DD_LOAD_STATUS 0x06 +#define GC5035_OTP_BIT_LOAD BIT(0) + +/* OTP-related definitions */ + +#define GC5035_OTP_ID_SIZE 9 +#define GC5035_OTP_ID_DATA_OFFSET 0x0020 +#define GC5035_OTP_DATA_LENGTH 1024 + +/* OTP DPC parameters */ +#define GC5035_OTP_DPC_FLAG_OFFSET 0x0068 +#define GC5035_OTP_DPC_FLAG_MASK 0x03 +#define GC5035_OTP_FLAG_EMPTY 0x00 +#define GC5035_OTP_FLAG_VALID 0x01 +#define GC5035_OTP_DPC_TOTAL_NUMBER_OFFSET 0x0070 +#define GC5035_OTP_DPC_ERROR_NUMBER_OFFSET 0x0078 + +/* OTP register parameters */ +#define GC5035_OTP_REG_FLAG_OFFSET 0x0880 +#define GC5035_OTP_REG_DATA_OFFSET 0x0888 +#define GC5035_OTP_REG_ADDR_OFFSET 1 +#define GC5035_OTP_REG_VAL_OFFSET 2 +#define GC5035_OTP_PAGE_FLAG_OFFSET 3 +#define GC5035_OTP_PER_PAGE_SIZE 4 +#define GC5035_OTP_REG_PAGE_MASK 0x07 +#define GC5035_OTP_REG_MAX_GROUP 5 +#define GC5035_OTP_REG_BYTE_PER_GROUP 5 +#define GC5035_OTP_REG_PER_GROUP 2 +#define GC5035_OTP_REG_BYTE_PER_REG 2 +#define GC5035_OTP_REG_DATA_SIZE 25 +#define GC5035_OTP_REG_SIZE 10 + +#define GC5035_DD_DELAY_US (10 * 1000) +#define GC5035_DD_TIMEOUT_US (100 * 1000) +static const char *const gc5035_supplies[] = {/* * Requested separately due to power sequencing needs: @@ -95,6 +146,21 @@ struct gc5035_regval {u8 val; }; +struct gc5035_reg { +u8 page; +struct gc5035_regval regval; +}; + +struct gc5035_otp_regs { +unsigned int num_regs; +struct gc5035_reg regs[GC5035_OTP_REG_SIZE ]; +}; + +struct gc5035_dpc { +bool valid; +unsigned int total_num; +}; +struct gc5035_mode {u32 width;u32 height;@@ -122,6 +188,11 @@ struct gc5035 {struct v4l2_ctrl *hblank;struct v4l2_ctrl *vblank; +bool otp_read; +u8 otp_id[GC5035_OTP_ID_SIZE ]; +struct gc5035_dpc dpc; +struct gc5035_otp_regs otp_regs; +/* * Serialize control access, get/set format, get selection * and start streaming. @@ -136,6 +207,69 @@ static inline struct gc5035 *to_gc5035(struct v4l2_subdev *sd) return container_of(sd, struct gc5035, subdev); } +static const struct gc5035_regval gc5035_otp_init_regs[] = { + {0xfc ,0x01 }, + {0xf4 ,0x40 }, + {0xf5 ,0xe9 }, + {0xf6 ,0x14 }, + {0xf8 ,0x49 }, + {0xf9 ,0x82 }, + {0xfa ,0x00 }, + {0xfc ,0x81 }, + {0xfe ,0x00 }, + {0x36 ,0x01 }, + {0xd3 ,0x87 }, + {0x36 ,0x00 }, + {0x33 ,0x00 }, + {0xf7 ,0x01 }, + {0xfc ,0x8e }, + {0xfe ,0x00 }, + {0xee ,0x30 }, + {0xfa ,0x10 }, + {0xf5 ,0xe9 }, + {0xfe ,0x02 }, + {0x67 ,0xc0 }, + {0x59 ,0x3f }, + {0x55 ,0x84 }, + {0x65 ,0x80 }, + {0x66 ,0x03 }, + {0xfe ,0x00 }, +}; + +static const struct gc5035_regval gc5035_otp_exit_regs[] = { + {0xfe ,0x02 }, + {0x67 ,0x00 }, + {0xfe ,0x00 }, + {0xfa ,0x00 }, +}; + +static const struct gc5035_regval gc5035_dd_auto_load_regs[] = { + {0xfe ,0x02 }, + {0xbe ,0x00 }, + {0xa9 ,0x01 }, + {0x09 ,0x33 }, +}; + +static const struct gc5035_regval gc5035_otp_dd_regs[] = { + {0x03 ,0x00 }, + {0x04 ,0x80 }, + {0x95 ,0x0a }, + {0x96 ,0x30 }, + {0x97 ,0x0a }, + {0x98 ,0x32 }, + {0x99 ,0x07 }, + {0x9a ,0xa9 }, + {0xf3 ,0x80 }, +}; + +static const struct gc5035_regval gc5035_otp_dd_enable_regs[] = { + {0xbe ,0x01 }, + {0x09 ,0x00 }, + {0xfe ,0x01 }, + {0x80 ,0x02 }, + {0xfe ,0x00 }, +}; +/* * Xclk 24Mhz * Pclk 87.6Mhz @@ -763,6 +897,346 @@ static int gc5035_read_reg(struct gc5035 *gc5035, u8 reg, u8 *val)return 0 ; } +static int gc5035_otp_read_data (struct gc5035 *gc5035,u16 bit_addr,u8 *data, +size_t length) +{ +size_t i; +int ret; + +if (WARN_ON (bit_addr %8 )) +return -EINVAL ; + +if (WARN_ON (bit_addr /8 + length >GC5035_OTP_DATA_LENGTH )) +return -EINVAL ; + + ret =gc5035_write_reg (gc5035,GC5035_PAGE_REG ,2 ); +if (ret) +return ret; + + ret =gc5035_write_reg (gc5035,GC5035_REG_OTP_ACCESS_ADDR_H , + (bit_addr >>8 ) & +GC5035_OTP_ACCESS_ADDR_H_MASK ); +if (ret) +return ret; + + ret =gc5035_write_reg (gc5035,GC5035_REG_OTP_ACCESS_ADDR_L , + bit_addr &0xff ); +if (ret) +return ret; + + ret =gc5035_write_reg (gc5035,GC5035_REG_OTP_MODE , +GC5035_OTP_PRE_READ ); +if (ret) + goto out_read_done; + + ret =gc5035_write_reg (gc5035,GC5035_REG_OTP_MODE , +GC5035_OTP_READ_MODE ); +if (ret) + goto out_read_done; + +for (i =0 ; i < length; i++) { + ret =gc5035_read_reg (gc5035,GC5035_REG_OTP_DATA , &data[i]); +if (ret) + goto out_read_done; + } + +out_read_done: +gc5035_write_reg (gc5035,GC5035_REG_OTP_MODE ,GC5035_OTP_READ_DONE ); + +return ret; +} + +static int gc5035_read_otp_regs (struct gc5035 *gc5035) +{ +struct device *dev = &gc5035->client->dev; +struct gc5035_otp_regs *otp_regs = &gc5035->otp_regs; +u8 regs[GC5035_OTP_REG_DATA_SIZE ] = {0 }; +unsigned int i, j; +u8 flag; +int ret; + + ret =gc5035_otp_read_data (gc5035,GC5035_OTP_REG_FLAG_OFFSET , + &flag,1 ); +if (ret) { +dev_err (dev,"failed to read otp reg flag\n" ); +return ret; + } + +dev_dbg (dev,"register update flag = 0x%x\n" , flag); + + gc5035->otp_regs.num_regs =0 ; +if (flag !=GC5035_OTP_FLAG_VALID ) +return 0 ; + + ret =gc5035_otp_read_data (gc5035,GC5035_OTP_REG_DATA_OFFSET , + regs,sizeof (regs)); +if (ret) { +dev_err (dev,"failed to read otp reg data\n" ); +return ret; + } + +for (i =0 ; i <GC5035_OTP_REG_MAX_GROUP ; i++) { +unsigned int base_group = i *GC5035_OTP_REG_BYTE_PER_GROUP ; + +for (j =0 ; j <GC5035_OTP_REG_PER_GROUP ; j++) { +struct gc5035_reg *reg; + +if (!(regs[base_group] & +BIT ((GC5035_OTP_PER_PAGE_SIZE * j + +GC5035_OTP_PAGE_FLAG_OFFSET )))) +continue ; + + reg = &otp_regs->regs[otp_regs->num_regs++]; + reg->page = (regs[base_group] >> + (GC5035_OTP_PER_PAGE_SIZE * j)) & +GC5035_OTP_REG_PAGE_MASK ; + reg->regval.addr = regs[base_group + j * +GC5035_OTP_REG_BYTE_PER_REG + +GC5035_OTP_REG_ADDR_OFFSET ]; + reg->regval.val = regs[base_group + j * +GC5035_OTP_REG_BYTE_PER_REG + +GC5035_OTP_REG_VAL_OFFSET ]; + } + } + +return 0 ; +} + +static int gc5035_read_dpc (struct gc5035 *gc5035) +{ +struct device *dev = &gc5035->client->dev; +struct gc5035_dpc *dpc = &gc5035->dpc; +u8 dpc_flag =0 ; +u8 error_number =0 ; +u8 total_number =0 ; +int ret; + + ret =gc5035_otp_read_data (gc5035,GC5035_OTP_DPC_FLAG_OFFSET , + &dpc_flag,1 ); +if (ret) { +dev_err (dev,"failed to read dpc flag\n" ); +return ret; + } + +dev_dbg (dev,"dpc flag = 0x%x\n" , dpc_flag); + + dpc->valid = false; + +switch (dpc_flag &GC5035_OTP_DPC_FLAG_MASK ) { +case GC5035_OTP_FLAG_EMPTY : +dev_dbg (dev,"dpc info is empty!!\n" ); +break ; + +case GC5035_OTP_FLAG_VALID : +dev_dbg (dev,"dpc info is valid!\n" ); + ret =gc5035_otp_read_data (gc5035, +GC5035_OTP_DPC_TOTAL_NUMBER_OFFSET , + &total_number,1 ); +if (ret) { +dev_err (dev,"failed to read dpc total number\n" ); +return ret; + } + + ret =gc5035_otp_read_data (gc5035, +GC5035_OTP_DPC_ERROR_NUMBER_OFFSET , + &error_number,1 ); +if (ret) { +dev_err (dev,"failed to read dpc error number\n" ); +return ret; + } + + dpc->total_num = total_number + error_number; + dpc->valid = true; +dev_dbg (dev,"total_num = %d\n" , dpc->total_num); +break ; + +default : +break ; + } + +return ret; +} + +static int gc5035_otp_read_sensor_info (struct gc5035 *gc5035) +{ +int ret; + + ret =gc5035_read_dpc (gc5035); +if (ret) +return ret; + +return gc5035_read_otp_regs (gc5035); +} + +static int gc5035_check_dd_load_status (struct gc5035 *gc5035) +{ +u8 status; +int ret; + + ret =gc5035_read_reg (gc5035,GC5035_REG_DD_LOAD_STATUS , &status); +if (ret) +return ret; + +if (status &GC5035_OTP_BIT_LOAD ) +return status; +else +return 0 ; +} + +static int gc5035_otp_update_dd (struct gc5035 *gc5035) +{ +struct device *dev = &gc5035->client->dev; +struct gc5035_dpc *dpc = &gc5035->dpc; +int val, ret; + +if (!dpc->valid) { +dev_dbg (dev,"DPC table invalid, not updating DD.\n" ); +return 0 ; + } + +dev_dbg (dev,"DD auto load start\n" ); + + ret =gc5035_write_array (gc5035, gc5035_dd_auto_load_regs, +ARRAY_SIZE (gc5035_dd_auto_load_regs)); +if (ret) { +dev_err (dev,"failed to write dd auto load reg\n" ); +return ret; + } + + ret =gc5035_write_reg (gc5035,GC5035_REG_DD_TOTALNUM_H , + (dpc->total_num >>8 ) & +GC5035_DD_TOTALNUM_H_MASK ); +if (ret) +return ret; + + ret =gc5035_write_reg (gc5035,GC5035_REG_DD_TOTALNUM_L , + dpc->total_num &0xff ); +if (ret) +return ret; + + ret =gc5035_write_array (gc5035, gc5035_otp_dd_regs, +ARRAY_SIZE (gc5035_otp_dd_regs)); +if (ret) +return ret; + +/* Wait for DD to finish loading automatically */ + ret =readx_poll_timeout (gc5035_check_dd_load_status, gc5035, + val, val <=0 ,GC5035_DD_DELAY_US , +GC5035_DD_TIMEOUT_US ); +if (ret <0 ) { +dev_err (dev,"DD load timeout\n" ); +return -EFAULT ; + } +if (val <0 ) { +dev_err (dev,"DD load failure\n" ); +return val; + } + + ret =gc5035_write_array (gc5035, gc5035_otp_dd_enable_regs, +ARRAY_SIZE (gc5035_otp_dd_enable_regs)); +if (ret) +return ret; + +return 0 ; +} + +static int gc5035_otp_update_regs (struct gc5035 *gc5035) +{ +struct device *dev = &gc5035->client->dev; +struct gc5035_otp_regs *otp_regs = &gc5035->otp_regs; +unsigned int i; +int ret; + +dev_dbg (dev,"reg count = %d\n" , otp_regs->num_regs); + +for (i =0 ; i < otp_regs->num_regs; i++) { + ret =gc5035_write_reg (gc5035,GC5035_PAGE_REG , + otp_regs->regs[i].page); +if (ret) +return ret; + + ret =gc5035_write_reg (gc5035, + otp_regs->regs[i].regval.addr, + otp_regs->regs[i].regval.val); +if (ret) +return ret; + } + +return 0 ; +} + +static int gc5035_otp_update (struct gc5035 *gc5035) +{ +struct device *dev = &gc5035->client->dev; +int ret; + + ret =gc5035_otp_update_dd (gc5035); +if (ret) { +dev_err (dev,"failed to update otp dd\n" ); +return ret; + } + + ret =gc5035_otp_update_regs (gc5035); +if (ret) { +dev_err (dev,"failed to update otp regs\n" ); +return ret; + } + +return ret; +} + +static int gc5035_set_otp_config (struct gc5035 *gc5035) +{ +struct device *dev = &gc5035->client->dev; +u8 otp_id[GC5035_OTP_ID_SIZE ]; +int ret;
drivers/media/i2c/gc5035.c static int gc5035_read_reg(struct gc5035 *gc5035, u8 reg, u8 *val) · line 1202
Quoted 10 lines
drivers/media/i2c/gc5035.c +10
-0+ + ret =gc5035_write_array (gc5035, gc5035_otp_init_regs, +ARRAY_SIZE (gc5035_otp_init_regs)); +if (ret) { +dev_err (dev,"failed to write otp init reg\n" ); +return ret; + } + + ret =gc5035_otp_read_data (gc5035,GC5035_OTP_ID_DATA_OFFSET , + &otp_id[0 ],GC5035_OTP_ID_SIZE );
Is this read needed every time when streaming is about to start?
I guess it's not wrong but it seems unnecessary on subsequent times.
Quoted 51 lines
drivers/media/i2c/gc5035.c +41
-0+if (ret) { +dev_err (dev,"failed to read otp id\n" ); + goto out_otp_exit; + } + +if (!gc5035->otp_read ||memcmp (gc5035->otp_id, otp_id,sizeof (otp_id))) { +dev_dbg (dev,"reading OTP configuration\n" ); + +memset (&gc5035->otp_regs,0 ,sizeof (gc5035->otp_regs)); +memset (&gc5035->dpc,0 ,sizeof (gc5035->dpc)); + +memcpy (gc5035->otp_id, otp_id,sizeof (gc5035->otp_id)); + + ret =gc5035_otp_read_sensor_info (gc5035); +if (ret <0 ) { +dev_err (dev,"failed to read otp info\n" ); + goto out_otp_exit; + } + + gc5035->otp_read = true; + } + + ret =gc5035_otp_update (gc5035); +if (ret <0 ) +return ret; + +out_otp_exit: + ret =gc5035_write_array (gc5035, gc5035_otp_exit_regs, +ARRAY_SIZE (gc5035_otp_exit_regs)); +if (ret) { +dev_err (dev,"failed to write otp exit reg\n" ); +return ret; + } + +return ret; +} +static int gc5035_set_fmt (struct v4l2_subdev *sd,struct v4l2_subdev_pad_config *cfg,struct v4l2_subdev_format *fmt)@@ -859,6 +1333,10 @@ static int __gc5035_start_stream(struct gc5035 *gc5035)if (ret)return ret; + ret =gc5035_set_otp_config (gc5035); +if (ret) +return ret; + ret =gc5035_write_array (gc5035, gc5035->cur_mode->reg_list, gc5035->cur_mode->num_regs);if (ret)
Signature · 3 lines
Kind regards, Sakari Ailus