* [PATCH 0/4] Add support for Toshiba TC358746
@ 2022-08-18 14:33 ` Marco Felsch
0 siblings, 0 replies; 34+ messages in thread
From: Marco Felsch @ 2022-08-18 14:33 UTC (permalink / raw)
To: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, laurent.pinchart+renesas
Cc: linux-kernel, linux-phy, devicetree, linux-media, kernel
Hi,
this small series adds the support for the Toshiba TC358746 MIPI-CSI to
Parallel converter chip. After a long period I finally had the time to
include Sakaris points made on my v2 [1]. Since [1] is long time ago
and I reworked the driver a lot, I don't add a v3 on this series. Also
all already provided RB tags are dropped.
Regards,
Marco
[1] https://www.mail-archive.com/linux-media@vger.kernel.org/msg147901.html
Marco Felsch (4):
phy: dphy: refactor get_default_config
phy: dphy: add support to calculate the timing based on hs_clk_rate
media: dt-bindings: add bindings for Toshiba TC358746
media: tc358746: add Toshiba TC358746 Parallel to CSI-2 bridge driver
.../bindings/media/i2c/toshiba,tc358746.yaml | 157 ++
drivers/media/i2c/Kconfig | 17 +
drivers/media/i2c/Makefile | 1 +
drivers/media/i2c/tc358746.c | 1645 +++++++++++++++++
drivers/phy/phy-core-mipi-dphy.c | 31 +-
include/linux/phy/phy-mipi-dphy.h | 3 +
6 files changed, 1850 insertions(+), 4 deletions(-)
create mode 100644 Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
create mode 100644 drivers/media/i2c/tc358746.c
--
2.30.2
^ permalink raw reply [flat|nested] 34+ messages in thread
* [PATCH 0/4] Add support for Toshiba TC358746
@ 2022-08-18 14:33 ` Marco Felsch
0 siblings, 0 replies; 34+ messages in thread
From: Marco Felsch @ 2022-08-18 14:33 UTC (permalink / raw)
To: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, laurent.pinchart+renesas
Cc: linux-kernel, linux-phy, devicetree, linux-media, kernel
Hi,
this small series adds the support for the Toshiba TC358746 MIPI-CSI to
Parallel converter chip. After a long period I finally had the time to
include Sakaris points made on my v2 [1]. Since [1] is long time ago
and I reworked the driver a lot, I don't add a v3 on this series. Also
all already provided RB tags are dropped.
Regards,
Marco
[1] https://www.mail-archive.com/linux-media@vger.kernel.org/msg147901.html
Marco Felsch (4):
phy: dphy: refactor get_default_config
phy: dphy: add support to calculate the timing based on hs_clk_rate
media: dt-bindings: add bindings for Toshiba TC358746
media: tc358746: add Toshiba TC358746 Parallel to CSI-2 bridge driver
.../bindings/media/i2c/toshiba,tc358746.yaml | 157 ++
drivers/media/i2c/Kconfig | 17 +
drivers/media/i2c/Makefile | 1 +
drivers/media/i2c/tc358746.c | 1645 +++++++++++++++++
drivers/phy/phy-core-mipi-dphy.c | 31 +-
include/linux/phy/phy-mipi-dphy.h | 3 +
6 files changed, 1850 insertions(+), 4 deletions(-)
create mode 100644 Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
create mode 100644 drivers/media/i2c/tc358746.c
--
2.30.2
--
linux-phy mailing list
linux-phy@lists.infradead.org
https://lists.infradead.org/mailman/listinfo/linux-phy
^ permalink raw reply [flat|nested] 34+ messages in thread
* [PATCH 1/4] phy: dphy: refactor get_default_config
2022-08-18 14:33 ` Marco Felsch
@ 2022-08-18 14:33 ` Marco Felsch
-1 siblings, 0 replies; 34+ messages in thread
From: Marco Felsch @ 2022-08-18 14:33 UTC (permalink / raw)
To: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, laurent.pinchart+renesas
Cc: linux-kernel, linux-phy, devicetree, linux-media, kernel
Factor out the calculation into phy_mipi_dphy_calc_config(). This is
needed for the follow up patch which adds the support to calculate the
timings based on a given hs clock. No functional changes are done.
Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
---
drivers/phy/phy-core-mipi-dphy.c | 11 ++++++++++-
1 file changed, 10 insertions(+), 1 deletion(-)
diff --git a/drivers/phy/phy-core-mipi-dphy.c b/drivers/phy/phy-core-mipi-dphy.c
index 929e86d6558e..ba365bc77407 100644
--- a/drivers/phy/phy-core-mipi-dphy.c
+++ b/drivers/phy/phy-core-mipi-dphy.c
@@ -17,7 +17,7 @@
* from the valid ranges specified in Section 6.9, Table 14, Page 41
* of the D-PHY specification (v1.2).
*/
-int phy_mipi_dphy_get_default_config(unsigned long pixel_clock,
+static int phy_mipi_dphy_calc_config(unsigned long pixel_clock,
unsigned int bpp,
unsigned int lanes,
struct phy_configure_opts_mipi_dphy *cfg)
@@ -75,6 +75,15 @@ int phy_mipi_dphy_get_default_config(unsigned long pixel_clock,
return 0;
}
+
+int phy_mipi_dphy_get_default_config(unsigned long pixel_clock,
+ unsigned int bpp,
+ unsigned int lanes,
+ struct phy_configure_opts_mipi_dphy *cfg)
+{
+ return phy_mipi_dphy_calc_config(pixel_clock, bpp, lanes, cfg);
+
+}
EXPORT_SYMBOL(phy_mipi_dphy_get_default_config);
/*
--
2.30.2
^ permalink raw reply related [flat|nested] 34+ messages in thread
* [PATCH 1/4] phy: dphy: refactor get_default_config
@ 2022-08-18 14:33 ` Marco Felsch
0 siblings, 0 replies; 34+ messages in thread
From: Marco Felsch @ 2022-08-18 14:33 UTC (permalink / raw)
To: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, laurent.pinchart+renesas
Cc: linux-kernel, linux-phy, devicetree, linux-media, kernel
Factor out the calculation into phy_mipi_dphy_calc_config(). This is
needed for the follow up patch which adds the support to calculate the
timings based on a given hs clock. No functional changes are done.
Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
---
drivers/phy/phy-core-mipi-dphy.c | 11 ++++++++++-
1 file changed, 10 insertions(+), 1 deletion(-)
diff --git a/drivers/phy/phy-core-mipi-dphy.c b/drivers/phy/phy-core-mipi-dphy.c
index 929e86d6558e..ba365bc77407 100644
--- a/drivers/phy/phy-core-mipi-dphy.c
+++ b/drivers/phy/phy-core-mipi-dphy.c
@@ -17,7 +17,7 @@
* from the valid ranges specified in Section 6.9, Table 14, Page 41
* of the D-PHY specification (v1.2).
*/
-int phy_mipi_dphy_get_default_config(unsigned long pixel_clock,
+static int phy_mipi_dphy_calc_config(unsigned long pixel_clock,
unsigned int bpp,
unsigned int lanes,
struct phy_configure_opts_mipi_dphy *cfg)
@@ -75,6 +75,15 @@ int phy_mipi_dphy_get_default_config(unsigned long pixel_clock,
return 0;
}
+
+int phy_mipi_dphy_get_default_config(unsigned long pixel_clock,
+ unsigned int bpp,
+ unsigned int lanes,
+ struct phy_configure_opts_mipi_dphy *cfg)
+{
+ return phy_mipi_dphy_calc_config(pixel_clock, bpp, lanes, cfg);
+
+}
EXPORT_SYMBOL(phy_mipi_dphy_get_default_config);
/*
--
2.30.2
--
linux-phy mailing list
linux-phy@lists.infradead.org
https://lists.infradead.org/mailman/listinfo/linux-phy
^ permalink raw reply related [flat|nested] 34+ messages in thread
* [PATCH 2/4] phy: dphy: add support to calculate the timing based on hs_clk_rate
2022-08-18 14:33 ` Marco Felsch
@ 2022-08-18 14:33 ` Marco Felsch
-1 siblings, 0 replies; 34+ messages in thread
From: Marco Felsch @ 2022-08-18 14:33 UTC (permalink / raw)
To: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, laurent.pinchart+renesas
Cc: linux-kernel, linux-phy, devicetree, linux-media, kernel
For MIPI-CSI sender use-case it is common to specify the allowed
link-frequencies which should be used for the MIPI link and is
half the hs-clock rate.
This commit adds a helper to calculate the D-PHY timing based on the
hs-clock rate so we don't need to calculate the timings within the
driver.
Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
---
drivers/phy/phy-core-mipi-dphy.c | 22 ++++++++++++++++++----
include/linux/phy/phy-mipi-dphy.h | 3 +++
2 files changed, 21 insertions(+), 4 deletions(-)
diff --git a/drivers/phy/phy-core-mipi-dphy.c b/drivers/phy/phy-core-mipi-dphy.c
index ba365bc77407..f4956a417a47 100644
--- a/drivers/phy/phy-core-mipi-dphy.c
+++ b/drivers/phy/phy-core-mipi-dphy.c
@@ -20,16 +20,18 @@
static int phy_mipi_dphy_calc_config(unsigned long pixel_clock,
unsigned int bpp,
unsigned int lanes,
+ unsigned long long hs_clk_rate,
struct phy_configure_opts_mipi_dphy *cfg)
{
- unsigned long long hs_clk_rate;
unsigned long long ui;
if (!cfg)
return -EINVAL;
- hs_clk_rate = pixel_clock * bpp;
- do_div(hs_clk_rate, lanes);
+ if (!hs_clk_rate) {
+ hs_clk_rate = pixel_clock * bpp;
+ do_div(hs_clk_rate, lanes);
+ }
ui = ALIGN(PSEC_PER_SEC, hs_clk_rate);
do_div(ui, hs_clk_rate);
@@ -81,11 +83,23 @@ int phy_mipi_dphy_get_default_config(unsigned long pixel_clock,
unsigned int lanes,
struct phy_configure_opts_mipi_dphy *cfg)
{
- return phy_mipi_dphy_calc_config(pixel_clock, bpp, lanes, cfg);
+ return phy_mipi_dphy_calc_config(pixel_clock, bpp, lanes, 0, cfg);
}
EXPORT_SYMBOL(phy_mipi_dphy_get_default_config);
+int phy_mipi_dphy_get_default_config_for_hsclk(unsigned long long hs_clk_rate,
+ unsigned int lanes,
+ struct phy_configure_opts_mipi_dphy *cfg)
+{
+ if (!hs_clk_rate)
+ return -EINVAL;
+
+ return phy_mipi_dphy_calc_config(0, 0, lanes, hs_clk_rate, cfg);
+
+}
+EXPORT_SYMBOL(phy_mipi_dphy_get_default_config_for_hsclk);
+
/*
* Validate D-PHY configuration according to MIPI D-PHY specification
* (v1.2, Section Section 6.9 "Global Operation Timing Parameters").
diff --git a/include/linux/phy/phy-mipi-dphy.h b/include/linux/phy/phy-mipi-dphy.h
index a877ffee845d..1ac128d78dfe 100644
--- a/include/linux/phy/phy-mipi-dphy.h
+++ b/include/linux/phy/phy-mipi-dphy.h
@@ -279,6 +279,9 @@ int phy_mipi_dphy_get_default_config(unsigned long pixel_clock,
unsigned int bpp,
unsigned int lanes,
struct phy_configure_opts_mipi_dphy *cfg);
+int phy_mipi_dphy_get_default_config_for_hsclk(unsigned long long hs_clk_rate,
+ unsigned int lanes,
+ struct phy_configure_opts_mipi_dphy *cfg);
int phy_mipi_dphy_config_validate(struct phy_configure_opts_mipi_dphy *cfg);
#endif /* __PHY_MIPI_DPHY_H_ */
--
2.30.2
^ permalink raw reply related [flat|nested] 34+ messages in thread
* [PATCH 2/4] phy: dphy: add support to calculate the timing based on hs_clk_rate
@ 2022-08-18 14:33 ` Marco Felsch
0 siblings, 0 replies; 34+ messages in thread
From: Marco Felsch @ 2022-08-18 14:33 UTC (permalink / raw)
To: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, laurent.pinchart+renesas
Cc: linux-kernel, linux-phy, devicetree, linux-media, kernel
For MIPI-CSI sender use-case it is common to specify the allowed
link-frequencies which should be used for the MIPI link and is
half the hs-clock rate.
This commit adds a helper to calculate the D-PHY timing based on the
hs-clock rate so we don't need to calculate the timings within the
driver.
Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
---
drivers/phy/phy-core-mipi-dphy.c | 22 ++++++++++++++++++----
include/linux/phy/phy-mipi-dphy.h | 3 +++
2 files changed, 21 insertions(+), 4 deletions(-)
diff --git a/drivers/phy/phy-core-mipi-dphy.c b/drivers/phy/phy-core-mipi-dphy.c
index ba365bc77407..f4956a417a47 100644
--- a/drivers/phy/phy-core-mipi-dphy.c
+++ b/drivers/phy/phy-core-mipi-dphy.c
@@ -20,16 +20,18 @@
static int phy_mipi_dphy_calc_config(unsigned long pixel_clock,
unsigned int bpp,
unsigned int lanes,
+ unsigned long long hs_clk_rate,
struct phy_configure_opts_mipi_dphy *cfg)
{
- unsigned long long hs_clk_rate;
unsigned long long ui;
if (!cfg)
return -EINVAL;
- hs_clk_rate = pixel_clock * bpp;
- do_div(hs_clk_rate, lanes);
+ if (!hs_clk_rate) {
+ hs_clk_rate = pixel_clock * bpp;
+ do_div(hs_clk_rate, lanes);
+ }
ui = ALIGN(PSEC_PER_SEC, hs_clk_rate);
do_div(ui, hs_clk_rate);
@@ -81,11 +83,23 @@ int phy_mipi_dphy_get_default_config(unsigned long pixel_clock,
unsigned int lanes,
struct phy_configure_opts_mipi_dphy *cfg)
{
- return phy_mipi_dphy_calc_config(pixel_clock, bpp, lanes, cfg);
+ return phy_mipi_dphy_calc_config(pixel_clock, bpp, lanes, 0, cfg);
}
EXPORT_SYMBOL(phy_mipi_dphy_get_default_config);
+int phy_mipi_dphy_get_default_config_for_hsclk(unsigned long long hs_clk_rate,
+ unsigned int lanes,
+ struct phy_configure_opts_mipi_dphy *cfg)
+{
+ if (!hs_clk_rate)
+ return -EINVAL;
+
+ return phy_mipi_dphy_calc_config(0, 0, lanes, hs_clk_rate, cfg);
+
+}
+EXPORT_SYMBOL(phy_mipi_dphy_get_default_config_for_hsclk);
+
/*
* Validate D-PHY configuration according to MIPI D-PHY specification
* (v1.2, Section Section 6.9 "Global Operation Timing Parameters").
diff --git a/include/linux/phy/phy-mipi-dphy.h b/include/linux/phy/phy-mipi-dphy.h
index a877ffee845d..1ac128d78dfe 100644
--- a/include/linux/phy/phy-mipi-dphy.h
+++ b/include/linux/phy/phy-mipi-dphy.h
@@ -279,6 +279,9 @@ int phy_mipi_dphy_get_default_config(unsigned long pixel_clock,
unsigned int bpp,
unsigned int lanes,
struct phy_configure_opts_mipi_dphy *cfg);
+int phy_mipi_dphy_get_default_config_for_hsclk(unsigned long long hs_clk_rate,
+ unsigned int lanes,
+ struct phy_configure_opts_mipi_dphy *cfg);
int phy_mipi_dphy_config_validate(struct phy_configure_opts_mipi_dphy *cfg);
#endif /* __PHY_MIPI_DPHY_H_ */
--
2.30.2
--
linux-phy mailing list
linux-phy@lists.infradead.org
https://lists.infradead.org/mailman/listinfo/linux-phy
^ permalink raw reply related [flat|nested] 34+ messages in thread
* [PATCH 3/4] media: dt-bindings: add bindings for Toshiba TC358746
2022-08-18 14:33 ` Marco Felsch
@ 2022-08-18 14:33 ` Marco Felsch
-1 siblings, 0 replies; 34+ messages in thread
From: Marco Felsch @ 2022-08-18 14:33 UTC (permalink / raw)
To: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, laurent.pinchart+renesas
Cc: linux-kernel, linux-phy, devicetree, linux-media, kernel
Add the bindings for the Toshiba TC358746 Parallel <-> MIPI-CSI bridge
driver.
Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
---
.../bindings/media/i2c/toshiba,tc358746.yaml | 157 ++++++++++++++++++
1 file changed, 157 insertions(+)
create mode 100644 Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
diff --git a/Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml b/Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
new file mode 100644
index 000000000000..9783cca363c6
--- /dev/null
+++ b/Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
@@ -0,0 +1,157 @@
+# SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause)
+%YAML 1.2
+---
+$id: http://devicetree.org/schemas/media/i2c/toshiba,tc358746.yaml#
+$schema: http://devicetree.org/meta-schemas/core.yaml#
+
+title: Toshiba TC358746 Parallel to MIPI CSI2 Bridge
+
+maintainers:
+ - Marco Felsch <kernel@pengutronix.de>
+
+description: |-
+ The Toshiba TC358746 converts a parallel video stream into a MIPI CSI-2
+ stream. The direction can be either parallel-in -> csi-out or csi-in ->
+ parallel-out The chip is programmable trough I2C and SPI but the SPI
+ interface is only supported in parallel-in -> csi-out mode.
+
+ Note that the current device tree bindings only support the
+ parallel-in -> csi-out path.
+
+properties:
+ compatible:
+ const: toshiba,tc358746
+
+ reg:
+ maxItems: 1
+
+ clocks:
+ description:
+ The phandle to the reference clock source. This corresponds to the
+ hardware pin REFCLK.
+ maxItems: 1
+
+ clock-names:
+ const: refclk
+
+# The bridge can act as clock provider for the sensor. To enable this support
+# #clock-cells must be specified. Attention if this feature is used than the
+# mclk rate must be at least: (2 * link-frequency) / 8
+# `------------------´ ^
+# internal PLL rate smallest possible mclk-div
+ "#clock-cells":
+ const: 0
+
+ clock-output-names:
+ description:
+ The clock name of the MCLK output, the default name is tc358746-mclk.
+ maxItems: 1
+
+ vddc-supply:
+ description: Digital core voltage supply, 1.2 volts
+
+ vddio-supply:
+ description: Digital I/O voltage supply, 1.8 volts
+
+ vddmipi-supply:
+ description: MIPI CSI phy voltage supply, 1.2 volts
+
+ reset-gpios:
+ description:
+ The phandle and specifier for the GPIO that controls the chip reset.
+ This corresponds to the hardware pin RESX which is physically active low.
+ maxItems: 1
+
+ ports:
+ $ref: /schemas/graph.yaml#/properties/ports
+ properties:
+ port@0:
+ $ref: /schemas/graph.yaml#/properties/port
+ description: Input port
+
+ port@1:
+ $ref: /schemas/graph.yaml#/$defs/port-base
+ description: Output port
+
+ properties:
+ endpoint:
+ $ref: /schemas/media/video-interfaces.yaml#
+ unevaluatedProperties: false
+
+ properties:
+ data-lanes:
+ minItems: 1
+ maxItems: 4
+
+ clock-noncontinuous: true
+ link-frequencies: true
+
+ required:
+ - data-lanes
+ - link-frequencies
+
+ required:
+ - port@0
+ - port@1
+
+required:
+ - compatible
+ - reg
+ - clocks
+ - clock-names
+ - vddc-supply
+ - vddio-supply
+ - vddmipi-supply
+ - ports
+
+additionalProperties: false
+
+examples:
+ - |
+ #include <dt-bindings/gpio/gpio.h>
+
+ i2c {
+ #address-cells = <1>;
+ #size-cells = <0>;
+
+ csi-bridge@e {
+ compatible = "toshiba,tc358746";
+ reg = <0xe>;
+
+ clocks = <&refclk>;
+ clock-names = "refclk";
+
+ reset-gpios = <&gpio 2 GPIO_ACTIVE_LOW>;
+
+ vddc-supply = <&v1_2d>;
+ vddio-supply = <&v1_8d>;
+ vddmipi-supply = <&v1_2d>;
+
+ /* sensor mclk provider */
+ #clock-cells = <0>;
+
+ ports {
+ #address-cells = <1>;
+ #size-cells = <0>;
+
+ /* Input */
+ port@0 {
+ reg = <0>;
+ tc358746_in: endpoint {
+ remote-endpoint = <&sensor_out>;
+ };
+ };
+
+ /* Output */
+ port@1 {
+ reg = <1>;
+ tc358746_out: endpoint {
+ remote-endpoint = <&mipi_csi2_in>;
+ data-lanes = <1 2>;
+ clock-noncontinuous;
+ link-frequencies = /bits/ 64 <216000000>;
+ };
+ };
+ };
+ };
+ };
--
2.30.2
^ permalink raw reply related [flat|nested] 34+ messages in thread
* [PATCH 3/4] media: dt-bindings: add bindings for Toshiba TC358746
@ 2022-08-18 14:33 ` Marco Felsch
0 siblings, 0 replies; 34+ messages in thread
From: Marco Felsch @ 2022-08-18 14:33 UTC (permalink / raw)
To: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, laurent.pinchart+renesas
Cc: linux-kernel, linux-phy, devicetree, linux-media, kernel
Add the bindings for the Toshiba TC358746 Parallel <-> MIPI-CSI bridge
driver.
Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
---
.../bindings/media/i2c/toshiba,tc358746.yaml | 157 ++++++++++++++++++
1 file changed, 157 insertions(+)
create mode 100644 Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
diff --git a/Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml b/Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
new file mode 100644
index 000000000000..9783cca363c6
--- /dev/null
+++ b/Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
@@ -0,0 +1,157 @@
+# SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause)
+%YAML 1.2
+---
+$id: http://devicetree.org/schemas/media/i2c/toshiba,tc358746.yaml#
+$schema: http://devicetree.org/meta-schemas/core.yaml#
+
+title: Toshiba TC358746 Parallel to MIPI CSI2 Bridge
+
+maintainers:
+ - Marco Felsch <kernel@pengutronix.de>
+
+description: |-
+ The Toshiba TC358746 converts a parallel video stream into a MIPI CSI-2
+ stream. The direction can be either parallel-in -> csi-out or csi-in ->
+ parallel-out The chip is programmable trough I2C and SPI but the SPI
+ interface is only supported in parallel-in -> csi-out mode.
+
+ Note that the current device tree bindings only support the
+ parallel-in -> csi-out path.
+
+properties:
+ compatible:
+ const: toshiba,tc358746
+
+ reg:
+ maxItems: 1
+
+ clocks:
+ description:
+ The phandle to the reference clock source. This corresponds to the
+ hardware pin REFCLK.
+ maxItems: 1
+
+ clock-names:
+ const: refclk
+
+# The bridge can act as clock provider for the sensor. To enable this support
+# #clock-cells must be specified. Attention if this feature is used than the
+# mclk rate must be at least: (2 * link-frequency) / 8
+# `------------------´ ^
+# internal PLL rate smallest possible mclk-div
+ "#clock-cells":
+ const: 0
+
+ clock-output-names:
+ description:
+ The clock name of the MCLK output, the default name is tc358746-mclk.
+ maxItems: 1
+
+ vddc-supply:
+ description: Digital core voltage supply, 1.2 volts
+
+ vddio-supply:
+ description: Digital I/O voltage supply, 1.8 volts
+
+ vddmipi-supply:
+ description: MIPI CSI phy voltage supply, 1.2 volts
+
+ reset-gpios:
+ description:
+ The phandle and specifier for the GPIO that controls the chip reset.
+ This corresponds to the hardware pin RESX which is physically active low.
+ maxItems: 1
+
+ ports:
+ $ref: /schemas/graph.yaml#/properties/ports
+ properties:
+ port@0:
+ $ref: /schemas/graph.yaml#/properties/port
+ description: Input port
+
+ port@1:
+ $ref: /schemas/graph.yaml#/$defs/port-base
+ description: Output port
+
+ properties:
+ endpoint:
+ $ref: /schemas/media/video-interfaces.yaml#
+ unevaluatedProperties: false
+
+ properties:
+ data-lanes:
+ minItems: 1
+ maxItems: 4
+
+ clock-noncontinuous: true
+ link-frequencies: true
+
+ required:
+ - data-lanes
+ - link-frequencies
+
+ required:
+ - port@0
+ - port@1
+
+required:
+ - compatible
+ - reg
+ - clocks
+ - clock-names
+ - vddc-supply
+ - vddio-supply
+ - vddmipi-supply
+ - ports
+
+additionalProperties: false
+
+examples:
+ - |
+ #include <dt-bindings/gpio/gpio.h>
+
+ i2c {
+ #address-cells = <1>;
+ #size-cells = <0>;
+
+ csi-bridge@e {
+ compatible = "toshiba,tc358746";
+ reg = <0xe>;
+
+ clocks = <&refclk>;
+ clock-names = "refclk";
+
+ reset-gpios = <&gpio 2 GPIO_ACTIVE_LOW>;
+
+ vddc-supply = <&v1_2d>;
+ vddio-supply = <&v1_8d>;
+ vddmipi-supply = <&v1_2d>;
+
+ /* sensor mclk provider */
+ #clock-cells = <0>;
+
+ ports {
+ #address-cells = <1>;
+ #size-cells = <0>;
+
+ /* Input */
+ port@0 {
+ reg = <0>;
+ tc358746_in: endpoint {
+ remote-endpoint = <&sensor_out>;
+ };
+ };
+
+ /* Output */
+ port@1 {
+ reg = <1>;
+ tc358746_out: endpoint {
+ remote-endpoint = <&mipi_csi2_in>;
+ data-lanes = <1 2>;
+ clock-noncontinuous;
+ link-frequencies = /bits/ 64 <216000000>;
+ };
+ };
+ };
+ };
+ };
--
2.30.2
--
linux-phy mailing list
linux-phy@lists.infradead.org
https://lists.infradead.org/mailman/listinfo/linux-phy
^ permalink raw reply related [flat|nested] 34+ messages in thread
* [PATCH 4/4] media: tc358746: add Toshiba TC358746 Parallel to CSI-2 bridge driver
2022-08-18 14:33 ` Marco Felsch
@ 2022-08-18 14:33 ` Marco Felsch
-1 siblings, 0 replies; 34+ messages in thread
From: Marco Felsch @ 2022-08-18 14:33 UTC (permalink / raw)
To: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, laurent.pinchart+renesas
Cc: linux-kernel, linux-phy, devicetree, linux-media, kernel
Adding support for the TC358746 parallel <-> MIPI CSI bridge. This chip
supports two operating modes:
1st) parallel-in -> mipi-csi out
2nd) mipi-csi in -> parallel out
This patch only adds the support for the 1st mode.
Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
---
drivers/media/i2c/Kconfig | 17 +
drivers/media/i2c/Makefile | 1 +
drivers/media/i2c/tc358746.c | 1645 ++++++++++++++++++++++++++++++++++
3 files changed, 1663 insertions(+)
create mode 100644 drivers/media/i2c/tc358746.c
diff --git a/drivers/media/i2c/Kconfig b/drivers/media/i2c/Kconfig
index 7806d4b81716..aefb9c9e0c08 100644
--- a/drivers/media/i2c/Kconfig
+++ b/drivers/media/i2c/Kconfig
@@ -1272,6 +1272,23 @@ config VIDEO_TC358743_CEC
When selected the tc358743 will support the optional
HDMI CEC feature.
+config VIDEO_TC358746
+ tristate "Toshiba TC358746 parallel-CSI2 bridge"
+ depends on VIDEO_DEV && I2C
+ select VIDEO_V4L2_SUBDEV_API
+ select MEDIA_CONTROLLER
+ select V4L2_FWNODE
+ select GENERIC_PHY_MIPI_DPHY
+ select REGMAP_I2C
+ select COMMON_CLK
+ help
+ Support for the Toshiba TC358746 parallel to MIPI CSI-2 bridge.
+ The bridge can work in both directions but currently only the
+ parallel-in / csi-out path is supported.
+
+ To compile this driver as a module, choose M here: the
+ module will be called tc358746.
+
config VIDEO_TVP514X
tristate "Texas Instruments TVP514x video decoder"
depends on VIDEO_DEV && I2C
diff --git a/drivers/media/i2c/Makefile b/drivers/media/i2c/Makefile
index 0a2933103dd9..d1096c2ab480 100644
--- a/drivers/media/i2c/Makefile
+++ b/drivers/media/i2c/Makefile
@@ -118,6 +118,7 @@ obj-$(CONFIG_VIDEO_SONY_BTF_MPX) += sony-btf-mpx.o
obj-$(CONFIG_VIDEO_SR030PC30) += sr030pc30.o
obj-$(CONFIG_VIDEO_ST_MIPID02) += st-mipid02.o
obj-$(CONFIG_VIDEO_TC358743) += tc358743.o
+obj-$(CONFIG_VIDEO_TC358746) += tc358746.o
obj-$(CONFIG_VIDEO_TDA1997X) += tda1997x.o
obj-$(CONFIG_VIDEO_TDA7432) += tda7432.o
obj-$(CONFIG_VIDEO_TDA9840) += tda9840.o
diff --git a/drivers/media/i2c/tc358746.c b/drivers/media/i2c/tc358746.c
new file mode 100644
index 000000000000..7b71d0cf72a9
--- /dev/null
+++ b/drivers/media/i2c/tc358746.c
@@ -0,0 +1,1645 @@
+// SPDX-License-Identifier: GPL-2.0-only
+/*
+ * TC358746 - Parallel <-> CSI-2 Bridge
+ *
+ * Copyright 2022 Marco Felsch <kernel@pengutronix.de>
+ *
+ * Notes:
+ * - Currently only 'Parallel-in -> CSI-out' mode is supported!
+ */
+
+#include <linux/bitfield.h>
+#include <linux/clk.h>
+#include <linux/clk-provider.h>
+#include <linux/delay.h>
+#include <linux/i2c.h>
+#include <linux/interrupt.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/phy/phy-mipi-dphy.h>
+#include <linux/property.h>
+#include <linux/pm_runtime.h>
+#include <linux/regmap.h>
+#include <media/v4l2-ctrls.h>
+#include <media/v4l2-device.h>
+#include <media/v4l2-fwnode.h>
+#include <media/v4l2-mc.h>
+
+/* 16-bit registers */
+#define CHIPID_REG 0x0000
+#define CHIPID GENMASK(15, 8)
+
+#define SYSCTL_REG 0x0002
+#define SRESET BIT(0)
+
+#define CONFCTL_REG 0x0004
+#define PDATAF_MASK GENMASK(9, 8)
+#define PDATAF_MODE0 0
+#define PDATAF_MODE1 1
+#define PDATAF_MODE2 2
+#define PDATAF(val) FIELD_PREP(PDATAF_MASK, (val))
+#define PPEN BIT(6)
+#define DATALANE_MASK GENMASK(1, 0)
+
+#define FIFOCTL_REG 0x0006
+#define DATAFMT_REG 0x0008
+#define PDFMT(val) FIELD_PREP(GENMASK(7, 4), (val))
+
+#define MCLKCTL_REG 0x000c
+#define MCLK_HIGH_MASK GENMASK(15, 8)
+#define MCLK_LOW_MASK GENMASK(7, 0)
+#define MCLK_HIGH(val) FIELD_PREP(MCLK_HIGH_MASK, (val))
+#define MCLK_LOW(val) FIELD_PREP(MCLK_LOW_MASK, (val))
+
+#define PLLCTL0_REG 0x0016
+#define PLL_PRD_MASK GENMASK(15, 12)
+#define PLL_PRD(val) FIELD_PREP(PLL_PRD_MASK, (val))
+#define PLL_FBD_MASK GENMASK(8, 0)
+#define PLL_FBD(val) FIELD_PREP(PLL_FBD_MASK, (val))
+
+#define PLLCTL1_REG 0x0018
+#define PLL_FRS_MASK GENMASK(11, 10)
+#define PLL_FRS(val) FIELD_PREP(PLL_FRS_MASK, (val))
+#define CKEN BIT(4)
+#define RESETB BIT(1)
+#define PLL_EN BIT(0)
+
+#define CLKCTL_REG 0x0020
+#define MCLKDIV_MASK GENMASK(3, 2)
+#define MCLKDIV(val) FIELD_PREP(MCLKDIV_MASK, (val))
+#define MCLKDIV_8 0
+#define MCLKDIV_4 1
+#define MCLKDIV_2 2
+
+#define WORDCNT_REG 0x0022
+#define PP_MISC_REG 0x0032
+#define FRMSTOP BIT(15)
+#define RSTPTR BIT(14)
+
+/* 32-bit registers */
+#define CLW_DPHYCONTTX_REG 0x0100
+#define CLW_CNTRL_REG 0x0140
+#define D0W_CNTRL_REG 0x0144
+#define LANEDISABLE BIT(0)
+
+#define STARTCNTRL_REG 0x0204
+#define START BIT(0)
+
+#define LINEINITCNT_REG 0x0210
+#define LPTXTIMECNT_REG 0x0214
+#define TCLK_HEADERCNT_REG 0x0218
+#define TCLK_ZEROCNT(val) FIELD_PREP(GENMASK(15, 8), (val))
+#define TCLK_PREPARECNT(val) FIELD_PREP(GENMASK(6, 0), (val))
+
+#define TCLK_TRAILCNT_REG 0x021C
+#define THS_HEADERCNT_REG 0x0220
+#define THS_ZEROCNT(val) FIELD_PREP(GENMASK(14, 8), (val))
+#define THS_PREPARECNT(val) FIELD_PREP(GENMASK(6, 0), (val))
+
+#define TWAKEUP_REG 0x0224
+#define TCLK_POSTCNT_REG 0x0228
+#define THS_TRAILCNT_REG 0x022C
+#define HSTXVREGEN_REG 0x0234
+#define TXOPTIONCNTRL_REG 0x0238
+#define CSI_CONTROL_REG 0x040C
+#define CSI_MODE BIT(15)
+#define TXHSMD BIT(7)
+#define NOL(val) FIELD_PREP(GENMASK(2, 1), (val))
+
+#define CSI_CONFW_REG 0x0500
+#define MODE(val) FIELD_PREP(GENMASK(31, 29), (val))
+#define MODE_SET 0x5
+#define ADDRESS(val) FIELD_PREP(GENMASK(28, 24), (val))
+#define CSI_CONTROL_ADDRESS 0x3
+#define DATA(val) FIELD_PREP(GENMASK(15, 0), (val))
+
+#define CSI_START_REG 0x0518
+#define STRT BIT(0)
+
+static const struct v4l2_mbus_framefmt tc358746_def_fmt = {
+ .width = 640,
+ .height = 480,
+ .code = MEDIA_BUS_FMT_UYVY8_2X8,
+ .field = V4L2_FIELD_NONE,
+ .colorspace = V4L2_COLORSPACE_DEFAULT,
+ .ycbcr_enc = V4L2_YCBCR_ENC_DEFAULT,
+ .quantization = V4L2_QUANTIZATION_DEFAULT,
+ .xfer_func = V4L2_XFER_FUNC_DEFAULT,
+};
+
+static const char * const tc358746_supplies[] = {
+ "vddc", "vddio", "vddmipi"
+};
+
+enum {
+ TC358746_SINK,
+ TC358746_SOURCE,
+ TC358746_NR_PADS
+};
+
+struct tc358746 {
+ struct v4l2_subdev sd;
+ struct media_pad pads[TC358746_NR_PADS];
+ struct v4l2_async_notifier notifier;
+ struct v4l2_mbus_framefmt mbusfmt;
+ struct v4l2_fwnode_endpoint csi_vep;
+
+ struct v4l2_ctrl_handler ctrl_hdl;
+
+ struct regmap *regmap;
+ struct clk *refclk;
+ struct gpio_desc *reset_gpio;
+ struct regulator_bulk_data supplies[ARRAY_SIZE(tc358746_supplies)];
+
+ struct clk_hw mclk_hw;
+ unsigned long mclk_rate;
+ u8 mclk_prediv;
+ u16 mclk_postdiv;
+
+ unsigned long pll_rate;
+ u8 pll_post_div;
+ u16 pll_pre_div;
+ u16 pll_mul;
+
+ struct v4l2_ctrl *sensor_pclk_ctrl;
+
+#define TC358746_VB_MAX_SIZE (511 * 32)
+#define TC358746_VB_DEFAULT_SIZE (1 * 32)
+ unsigned int vb_size; /* Video buffer size in bits */
+
+ struct phy_configure_opts_mipi_dphy dphy_cfg;
+};
+
+static inline struct tc358746 *to_tc358746(struct v4l2_subdev *sd)
+{
+ return container_of(sd, struct tc358746, sd);
+}
+
+static inline struct tc358746 *clk_hw_to_tc358746(struct clk_hw *hw)
+{
+ return container_of(hw, struct tc358746, mclk_hw);
+}
+
+struct tc358746_format {
+ u32 code;
+ bool csi_format;
+ unsigned char bus_width;
+ unsigned char bpp;
+ /* Register values */
+ u8 pdformat; /* Peripheral Data Format */
+ u8 pdataf; /* Parallel Data Format Option */
+};
+
+enum {
+ PDFORMAT_RAW8 = 0,
+ PDFORMAT_RAW10,
+ PDFORMAT_RAW12,
+ PDFORMAT_RGB888,
+ PDFORMAT_RGB666,
+ PDFORMAT_RGB565,
+ PDFORMAT_YUV422_8BIT,
+ /* RESERVED = 7 */
+ PDFORMAT_RAW14 = 8,
+ PDFORMAT_YUV422_10BIT,
+ PDFORMAT_YUV444,
+};
+
+/* Check tc358746_src_mbus_code() if you add new formats */
+static const struct tc358746_format tc358746_formats[] = {
+ {
+ .code = MEDIA_BUS_FMT_UYVY8_2X8,
+ .bus_width = 8,
+ .bpp = 16,
+ .pdformat = PDFORMAT_YUV422_8BIT,
+ .pdataf = PDATAF_MODE0,
+ }, {
+ .code = MEDIA_BUS_FMT_UYVY8_1X16,
+ .csi_format = true,
+ .bus_width = 16,
+ .bpp = 16,
+ .pdformat = PDFORMAT_YUV422_8BIT,
+ .pdataf = PDATAF_MODE1,
+ }, {
+ .code = MEDIA_BUS_FMT_YUYV8_1X16,
+ .csi_format = true,
+ .bus_width = 16,
+ .bpp = 16,
+ .pdformat = PDFORMAT_YUV422_8BIT,
+ .pdataf = PDATAF_MODE2,
+ }, {
+ .code = MEDIA_BUS_FMT_UYVY10_2X10,
+ .bus_width = 10,
+ .bpp = 20,
+ .pdformat = PDFORMAT_YUV422_10BIT,
+ .pdataf = PDATAF_MODE0, /* don't care */
+ }, {
+ /* in datasheet listed as YUV444 */
+ .code = MEDIA_BUS_FMT_GBR888_1X24,
+ .csi_format = true,
+ .bus_width = 24,
+ .bpp = 24,
+ .pdformat = PDFORMAT_YUV444,
+ .pdataf = PDATAF_MODE0, /* don't care */
+ },
+};
+
+/* Get n-th format for pad */
+static const struct tc358746_format *
+tc358746_get_format_by_idx(unsigned int pad, unsigned int index)
+{
+ unsigned int idx = 0;
+ unsigned int i;
+
+ if (pad >= TC358746_NR_PADS)
+ return ERR_PTR(-EINVAL);
+
+ for (i = 0; i < ARRAY_SIZE(tc358746_formats); i++) {
+ const struct tc358746_format *fmt = &tc358746_formats[i];
+
+ if ((pad == TC358746_SOURCE && fmt->csi_format) ||
+ (pad == TC358746_SINK)) {
+ if (idx == index)
+ return fmt;
+ idx++;
+ }
+ }
+
+ return ERR_PTR(-EINVAL);
+}
+
+static const struct tc358746_format *
+tc358746_get_format_by_code(unsigned int pad, u32 code)
+{
+ unsigned int i;
+
+ if (pad >= TC358746_NR_PADS)
+ return ERR_PTR(-EINVAL);
+
+ for (i = 0; i < ARRAY_SIZE(tc358746_formats); i++) {
+ const struct tc358746_format *fmt = &tc358746_formats[i];
+
+ if (pad == TC358746_SINK && fmt->code == code)
+ return fmt;
+
+ if (pad == TC358746_SOURCE && fmt->csi_format &&
+ fmt->code == code)
+ return fmt;
+ }
+
+ return ERR_PTR(-EINVAL);
+}
+
+static u32 tc358746_src_mbus_code(u32 code)
+{
+ switch (code) {
+ case MEDIA_BUS_FMT_UYVY8_2X8:
+ return MEDIA_BUS_FMT_UYVY8_1X16;
+ case MEDIA_BUS_FMT_UYVY10_2X10:
+ return MEDIA_BUS_FMT_UYVY10_1X20;
+ default:
+ return code;
+ }
+}
+
+static bool tc358746_writeable_reg(struct device *dev, unsigned int reg)
+{
+ switch (reg) {
+ case SYSCTL_REG ... CSI_START_REG:
+ return true;
+ default:
+ return false;
+ }
+}
+
+static bool tc358746_readable_reg(struct device *dev, unsigned int reg)
+{
+ switch (reg) {
+ case CHIPID_REG ... CSI_START_REG:
+ return true;
+ default:
+ return false;
+ }
+}
+
+static const struct regmap_config tc358746_regmap_config = {
+ .name = "tc358746",
+ .reg_bits = 16,
+ .val_bits = 16,
+ .max_register = CSI_START_REG,
+ .writeable_reg = tc358746_writeable_reg,
+ .readable_reg = tc358746_readable_reg,
+ .reg_format_endian = REGMAP_ENDIAN_BIG,
+ .val_format_endian = REGMAP_ENDIAN_BIG,
+};
+
+static int tc358746_write(struct tc358746 *tc358746, u32 reg, u32 val)
+{
+ size_t count;
+
+ /* 32-bit registers starting from CLW_DPHYCONTTX */
+ count = reg < CLW_DPHYCONTTX_REG ? 1 : 2;
+
+ return regmap_bulk_write(tc358746->regmap, reg, &val, count);
+}
+
+static int tc358746_read(struct tc358746 *tc358746, u32 reg, u32 *val)
+{
+ size_t count;
+
+ /* 32-bit registers starting from CLW_DPHYCONTTX */
+ count = reg < CLW_DPHYCONTTX_REG ? 1 : 2;
+ *val = 0;
+
+ return regmap_bulk_read(tc358746->regmap, reg, val, count);
+}
+
+static int
+tc358746_update_bits(struct tc358746 *tc358746, u32 reg, u32 mask, u32 val)
+{
+ u32 tmp, orig;
+ int err;
+
+ err = tc358746_read(tc358746, reg, &orig);
+ if (err)
+ return err;
+
+ tmp = orig & ~mask;
+ tmp |= val & mask;
+
+ return tc358746_write(tc358746, reg, tmp);
+}
+
+static int tc358746_set_bits(struct tc358746 *tc358746, u32 reg, u32 bits)
+{
+ return tc358746_update_bits(tc358746, reg, bits, bits);
+}
+
+static int tc358746_clear_bits(struct tc358746 *tc358746, u32 reg, u32 bits)
+{
+ return tc358746_update_bits(tc358746, reg, bits, 0);
+}
+
+static int tc358746_sw_reset(struct tc358746 *tc358746)
+{
+ int err;
+
+ err = tc358746_set_bits(tc358746, SYSCTL_REG, SRESET);
+ if (err)
+ return err;
+
+ udelay(10);
+
+ return tc358746_clear_bits(tc358746, SYSCTL_REG, SRESET);
+}
+
+static int
+tc358746_apply_pll_config(struct tc358746 *tc358746)
+{
+ u8 post = tc358746->pll_post_div;
+ u16 pre = tc358746->pll_pre_div;
+ u16 mul = tc358746->pll_mul;
+ u32 val, mask;
+ int err;
+
+ err = tc358746_read(tc358746, PLLCTL1_REG, &val);
+ if (err)
+ return err;
+
+ /* Don't touch the PLL if running */
+ if (FIELD_GET(PLL_EN, val) == 1)
+ return 0;
+
+ /* Pre-div and Multiplicator have a internal +1 logic */
+ val = PLL_PRD(pre - 1) | PLL_FBD(mul - 1);
+ mask = PLL_PRD_MASK | PLL_FBD_MASK;
+ err = tc358746_update_bits(tc358746, PLLCTL0_REG, mask, val);
+ if (err)
+ return err;
+
+ val = PLL_FRS(ilog2(post)) | RESETB | PLL_EN;
+ mask = PLL_FRS_MASK | RESETB | PLL_EN;
+ tc358746_update_bits(tc358746, PLLCTL1_REG, mask, val);
+ if (err)
+ return err;
+
+ udelay(1000);
+
+ return tc358746_set_bits(tc358746, PLLCTL1_REG, CKEN);
+}
+
+static int tc358746_apply_misc_config(struct tc358746 *tc358746)
+{
+ struct device *dev = tc358746->sd.dev;
+ const struct tc358746_format *fmt;
+ u32 val;
+ int err;
+
+ fmt = tc358746_get_format_by_code(TC358746_SINK, tc358746->mbusfmt.code);
+ if (IS_ERR(fmt))
+ return PTR_ERR(fmt);
+
+ /* Self defined CSI user data type id's are not supported yet */
+ val = PDFMT(fmt->pdformat);
+ dev_dbg(dev, "DATAFMT: 0x%x\n", val);
+ err = tc358746_write(tc358746, DATAFMT_REG, val);
+ if (err)
+ return err;
+
+ val = PDATAF(fmt->pdataf);
+ dev_dbg(dev, "CONFCTL[PDATAF]: 0x%x\n", fmt->pdataf);
+ err = tc358746_update_bits(tc358746, CONFCTL_REG, PDATAF_MASK, val);
+ if (err)
+ return err;
+
+ val = tc358746->vb_size / 32;
+ dev_dbg(dev, "FIFOCTL: %u (0x%x)\n", val, val);
+ err = tc358746_write(tc358746, FIFOCTL_REG, val);
+ if (err)
+ return err;
+
+ /* Total number of bytes for each line/width */
+ val = tc358746->mbusfmt.width * fmt->bpp / 8;
+ dev_dbg(dev, "WORDCNT: %u (0x%x)\n", val, val);
+ return tc358746_write(tc358746, WORDCNT_REG, val);
+}
+
+#ifndef MHZ
+#define MHZ (1000 * 1000)
+#endif
+
+/* Use MHz as base so the div needs no u64 */
+static u32 tc358746_cfg_to_cnt(unsigned int cfg_val,
+ unsigned int clk_mhz,
+ unsigned int time_base)
+{
+ return DIV_ROUND_UP(cfg_val * clk_mhz, time_base);
+}
+
+static u32 tc358746_ps_to_cnt(unsigned int cfg_val,
+ unsigned int clk_mhz)
+{
+ return tc358746_cfg_to_cnt(cfg_val, clk_mhz, USEC_PER_SEC);
+}
+
+static u32 tc358746_us_to_cnt(unsigned int cfg_val,
+ unsigned int clk_mhz)
+{
+ return tc358746_cfg_to_cnt(cfg_val, clk_mhz, 1);
+}
+
+static int tc358746_apply_dphy_config(struct tc358746 *tc358746)
+{
+ struct phy_configure_opts_mipi_dphy *cfg = &tc358746->dphy_cfg;
+ bool non_cont_clk = !!(tc358746->csi_vep.bus.mipi_csi2.flags &
+ V4L2_MBUS_CSI2_NONCONTINUOUS_CLOCK);
+ struct device *dev = tc358746->sd.dev;
+ unsigned long hs_byte_clk, hf_clk;
+ u32 val, val2, lptxcnt;
+ int err;
+
+ /* The hs_byte_clk is also called SYSCLK in the excel sheet */
+ hs_byte_clk = cfg->hs_clk_rate / 8;
+ hs_byte_clk /= MHZ;
+ hf_clk = hs_byte_clk / 2;
+
+ val = tc358746_us_to_cnt(cfg->init, hf_clk) - 1;
+ dev_dbg(dev, "LINEINITCNT: %u (0x%x)\n", val, val);
+ err = tc358746_write(tc358746, LINEINITCNT_REG, val);
+ if (err)
+ return err;
+
+ val = tc358746_ps_to_cnt(cfg->lpx, hs_byte_clk) - 1;
+ lptxcnt = val;
+ dev_dbg(dev, "LPTXTIMECNT: %u (0x%x)\n", val, val);
+ err = tc358746_write(tc358746, LPTXTIMECNT_REG, val);
+ if (err)
+ return err;
+
+ val = tc358746_ps_to_cnt(cfg->clk_prepare, hs_byte_clk) - 1;
+ val2 = tc358746_ps_to_cnt(cfg->clk_zero, hs_byte_clk) - 1;
+ dev_dbg(dev, "TCLK_PREPARECNT: %u (0x%x)\n", val, val);
+ dev_dbg(dev, "TCLK_ZEROCNT: %u (0x%x)\n", val2, val2);
+ dev_dbg(dev, "TCLK_HEADERCNT: 0x%x\n",
+ (u32)(TCLK_PREPARECNT(val) | TCLK_ZEROCNT(val2)));
+ err = tc358746_write(tc358746, TCLK_HEADERCNT_REG,
+ TCLK_PREPARECNT(val) | TCLK_ZEROCNT(val2));
+ if (err)
+ return err;
+
+ val = tc358746_ps_to_cnt(cfg->clk_trail, hs_byte_clk);
+ dev_dbg(dev, "TCLK_TRAILCNT: %u (0x%x)\n", val, val);
+ err = tc358746_write(tc358746, TCLK_TRAILCNT_REG, val);
+ if (err)
+ return err;
+
+ val = tc358746_ps_to_cnt(cfg->hs_prepare, hs_byte_clk) - 1;
+ val2 = tc358746_ps_to_cnt(cfg->hs_zero, hs_byte_clk) - 1;
+ dev_dbg(dev, "THS_PREPARECNT: %u (0x%x)\n", val, val);
+ dev_dbg(dev, "THS_ZEROCNT: %u (0x%x)\n", val2, val2);
+ dev_dbg(dev, "THS_HEADERCNT: 0x%x\n",
+ (u32)(THS_PREPARECNT(val) | THS_ZEROCNT(val2)));
+ err = tc358746_write(tc358746, THS_HEADERCNT_REG,
+ THS_PREPARECNT(val) | THS_ZEROCNT(val2));
+ if (err)
+ return err;
+
+ /* TWAKEUP > 1ms in lptxcnt steps */
+ val = tc358746_us_to_cnt(cfg->wakeup, hs_byte_clk);
+ val = val / (lptxcnt + 1) - 1;
+ dev_dbg(dev, "TWAKEUP: %u (0x%x)\n", val, val);
+ err = tc358746_write(tc358746, TWAKEUP_REG, val);
+ if (err)
+ return err;
+
+ val = tc358746_ps_to_cnt(cfg->clk_post, hs_byte_clk);
+ dev_dbg(dev, "TCLK_POSTCNT: %u (0x%x)\n", val, val);
+ err = tc358746_write(tc358746, TCLK_POSTCNT_REG, val);
+ if (err)
+ return err;
+
+ val = tc358746_ps_to_cnt(cfg->hs_trail, hs_byte_clk);
+ dev_dbg(dev, "THS_TRAILCNT: %u (0x%x)\n", val, val);
+ err = tc358746_write(tc358746, THS_TRAILCNT_REG, val);
+ if (err)
+ return err;
+
+ dev_dbg(dev, "CONTCLKMODE: %u", non_cont_clk ? 0 : 1);
+ return tc358746_write(tc358746, TXOPTIONCNTRL_REG, non_cont_clk ? 0 : 1);
+}
+
+#define MAX_DATA_LANES 4
+
+static int tc358746_enable_csi_lanes(struct tc358746 *tc358746, int enable)
+{
+ unsigned int lanes = tc358746->dphy_cfg.lanes;
+ unsigned int lane;
+ u32 reg, val;
+ int err;
+
+ err = tc358746_update_bits(tc358746, CONFCTL_REG, DATALANE_MASK,
+ lanes - 1);
+ if (err)
+ return err;
+
+ /* Clock lane */
+ val = enable ? 0 : LANEDISABLE;
+ dev_dbg(tc358746->sd.dev, "CLW_CNTRL: 0x%x\n", val);
+ err = tc358746_write(tc358746, CLW_CNTRL_REG, val);
+ if (err)
+ return err;
+
+ for (lane = 0; lane < MAX_DATA_LANES; lane++) {
+ /* Data lanes */
+ reg = D0W_CNTRL_REG + lane * 0x4;
+ val = (enable && lane < lanes) ? 0 : LANEDISABLE;
+
+ dev_dbg(tc358746->sd.dev, "D%uW_CNTRL: 0x%x\n", lane, val);
+ err = tc358746_write(tc358746, reg, val);
+ if (err)
+ return err;
+ }
+
+ val = 0;
+ if (enable) {
+ /* Clock lane */
+ val |= BIT(0);
+
+ /* Data lanes */
+ for (lane = 1; lane <= lanes; lane++)
+ val |= BIT(lane);
+ }
+
+ dev_dbg(tc358746->sd.dev, "HSTXVREGEN: 0x%x\n", val);
+ return tc358746_write(tc358746, HSTXVREGEN_REG, val);
+}
+
+static int tc358746_enable_csi_module(struct tc358746 *tc358746, int enable)
+{
+ unsigned int lanes = tc358746->dphy_cfg.lanes;
+ int err;
+
+ /*
+ * START and STRT are only reseted/disabled by sw reset. This is
+ * required to put the lane state back into LP-11 state. The sw reset
+ * don't reset register values.
+ */
+ if (!enable)
+ return tc358746_sw_reset(tc358746);
+
+ err = tc358746_write(tc358746, STARTCNTRL_REG, START);
+ if (err)
+ return err;
+
+ err = tc358746_write(tc358746, CSI_START_REG, STRT);
+ if (err)
+ return err;
+
+ /* CSI_CONTROL_REG is only indirect accessible */
+ return tc358746_write(tc358746, CSI_CONFW_REG,
+ MODE(MODE_SET) |
+ ADDRESS(CSI_CONTROL_ADDRESS) |
+ DATA(CSI_MODE | TXHSMD | NOL(lanes - 1)));
+}
+
+static int tc358746_enable_parallel_port(struct tc358746 *tc358746, int enable)
+{
+ int err;
+
+ if (enable) {
+ err = tc358746_write(tc358746, PP_MISC_REG, 0);
+ if (err)
+ return err;
+
+ return tc358746_set_bits(tc358746, CONFCTL_REG, PPEN);
+ }
+
+ err = tc358746_set_bits(tc358746, PP_MISC_REG, FRMSTOP);
+ if (err)
+ return err;
+
+ err = tc358746_clear_bits(tc358746, CONFCTL_REG, PPEN);
+ if (err)
+ return err;
+
+ return tc358746_set_bits(tc358746, PP_MISC_REG, RSTPTR);
+}
+
+static inline struct v4l2_subdev *tc358746_get_remote_sd(struct media_pad *pad)
+{
+ pad = media_pad_remote_pad_first(pad);
+ if (!pad)
+ return NULL;
+
+ return media_entity_to_v4l2_subdev(pad->entity);
+}
+
+static int tc358746_s_stream(struct v4l2_subdev *sd, int enable)
+{
+ struct tc358746 *tc358746 = to_tc358746(sd);
+ struct v4l2_subdev *src;
+ int err;
+
+ dev_dbg(sd->dev, "%sable\n", enable ? "en" : "dis");
+
+ src = tc358746_get_remote_sd(&tc358746->pads[TC358746_SINK]);
+ if (!src)
+ return -EPIPE;
+
+ if (enable) {
+ err = pm_runtime_resume_and_get(sd->dev);
+ if (err)
+ return err;
+
+ err = tc358746_enable_csi_lanes(tc358746, 1);
+ if (err) {
+ pm_runtime_mark_last_busy(sd->dev);
+ pm_runtime_put_sync_autosuspend(sd->dev);
+ return err;
+ }
+
+ err = tc358746_enable_csi_module(tc358746, 1);
+ if (err) {
+ pm_runtime_mark_last_busy(sd->dev);
+ pm_runtime_put_sync_autosuspend(sd->dev);
+ return err;
+ }
+
+ err = tc358746_enable_parallel_port(tc358746, 1);
+ if (err) {
+ pm_runtime_mark_last_busy(sd->dev);
+ pm_runtime_put_sync_autosuspend(sd->dev);
+ return err;
+ }
+
+ err = v4l2_subdev_call(src, video, s_stream, 1);
+ if (err) {
+ pm_runtime_mark_last_busy(sd->dev);
+ pm_runtime_put_sync_autosuspend(sd->dev);
+ }
+
+ return err;
+ }
+
+ /*
+ * Lane disable trigger state change from LP-11 to LP-00
+ * therefore it must happen before the CSI modile is disabled.
+ */
+ err = tc358746_enable_csi_lanes(tc358746, 0);
+ if (err)
+ return err;
+
+ err = tc358746_enable_csi_module(tc358746, 0);
+ if (err)
+ return err;
+
+ err = tc358746_enable_parallel_port(tc358746, 0);
+ if (err)
+ return err;
+
+ pm_runtime_mark_last_busy(sd->dev);
+ pm_runtime_put_sync_autosuspend(sd->dev);
+
+ return v4l2_subdev_call(src, video, s_stream, 0);
+}
+
+static int tc358746_enum_mbus_code(struct v4l2_subdev *sd,
+ struct v4l2_subdev_state *sd_state,
+ struct v4l2_subdev_mbus_code_enum *code)
+{
+ const struct tc358746_format *fmt;
+
+ fmt = tc358746_get_format_by_idx(code->pad, code->index);
+ if (IS_ERR(fmt))
+ return PTR_ERR(fmt);
+
+ code->code = fmt->code;
+
+ return 0;
+}
+
+static struct v4l2_mbus_framefmt *
+__tc358746_get_pad_format(struct v4l2_subdev *sd,
+ struct v4l2_subdev_state *sd_state,
+ unsigned int pad, u32 which)
+{
+ struct tc358746 *tc358746 = to_tc358746(sd);
+
+ switch (which) {
+ case V4L2_SUBDEV_FORMAT_TRY:
+ return v4l2_subdev_get_try_format(sd, sd_state, pad);
+ case V4L2_SUBDEV_FORMAT_ACTIVE:
+ return &tc358746->mbusfmt;
+ default:
+ return NULL;
+ }
+}
+
+static int tc358746_get_fmt(struct v4l2_subdev *sd,
+ struct v4l2_subdev_state *sd_state,
+ struct v4l2_subdev_format *format)
+{
+ struct tc358746 *tc358746 = to_tc358746(sd);
+
+ if (format->pad >= TC358746_NR_PADS)
+ return -EINVAL;
+
+ format->format = tc358746->mbusfmt;
+ if (format->pad == TC358746_SOURCE)
+ format->format.code = tc358746_src_mbus_code(tc358746->mbusfmt.code);
+
+ return 0;
+}
+
+static int tc358746_set_fmt(struct v4l2_subdev *sd,
+ struct v4l2_subdev_state *sd_state,
+ struct v4l2_subdev_format *format)
+{
+ struct v4l2_mbus_framefmt *mbusformat;
+ const struct tc358746_format *fmt;
+
+ if (format->pad >= TC358746_NR_PADS)
+ return -EINVAL;
+
+ /* The src follows the properties from the sink */
+ if (format->pad == TC358746_SOURCE)
+ return tc358746_get_fmt(sd, sd_state, format);
+
+ mbusformat = __tc358746_get_pad_format(sd, sd_state, format->pad,
+ format->which);
+ if (!mbusformat)
+ return -EINVAL;
+
+ fmt = tc358746_get_format_by_code(format->pad, format->format.code);
+ if (IS_ERR(fmt))
+ fmt = tc358746_get_format_by_code(format->pad, tc358746_def_fmt.code);
+
+ format->format.code = fmt->code;
+ format->format.field = V4L2_FIELD_NONE;
+
+ dev_dbg(sd->dev, "Update format: %ux%u code:0x%x -> %ux%u code:0x%x",
+ mbusformat->width, mbusformat->height, mbusformat->code,
+ format->format.width, format->format.height, format->format.code);
+
+ *mbusformat = format->format;
+
+ return 0;
+}
+
+static unsigned long tc358746_find_pll_settings(struct tc358746 *tc358746,
+ unsigned long refclk,
+ unsigned long fout)
+
+{
+ struct device *dev = tc358746->sd.dev;
+ unsigned long best_freq = 0;
+ u32 min_delta = 0xffffffff;
+ u16 prediv_max = 17;
+ u16 prediv_min = 1;
+ u16 m_best, mul;
+ u16 p_best, p;
+ u8 postdiv;
+
+ if (fout > 1000 * MHZ) {
+ dev_err(dev, "HS-Clock above 1 Ghz are not supported\n");
+ return 0;
+ } else if (fout >= 500 * MHZ)
+ postdiv = 1;
+ else if (fout >= 250 * MHZ)
+ postdiv = 2;
+ else if (fout >= 125 * MHZ)
+ postdiv = 4;
+ else
+ postdiv = 8;
+
+ for (p = prediv_min; p <= prediv_max; p++) {
+ unsigned long delta, fin;
+ u64 tmp;
+
+ fin = DIV_ROUND_CLOSEST(refclk, p);
+ if (fin < 4 * MHZ || fin > 40 * MHZ)
+ continue;
+
+ tmp = fout * p * postdiv;
+ do_div(tmp, fin);
+ mul = tmp;
+ if (mul > 511)
+ continue;
+
+ tmp = mul * fin;
+ do_div(tmp, p * postdiv);
+
+ delta = abs(fout - tmp);
+ if (delta < min_delta) {
+ p_best = p;
+ m_best = mul;
+ min_delta = delta;
+ best_freq = tmp;
+ };
+
+ if (delta == 0)
+ break;
+ };
+
+ if (!best_freq) {
+ dev_err(dev, "Failed find PLL frequency\n");
+ return 0;
+ }
+
+ tc358746->pll_post_div = postdiv;
+ tc358746->pll_pre_div = p_best;
+ tc358746->pll_mul = m_best;
+
+ if (best_freq != fout)
+ dev_warn(dev, "Request PLL freq:%lu, found PLL freq:%lu\n",
+ fout, best_freq);
+
+ dev_dbg(dev, "Found PLL settings: freq:%lu prediv:%u multi:%u postdiv:%u\n",
+ best_freq, p_best, m_best, postdiv);
+
+ return best_freq;
+}
+
+#define TC358746_PRECISION 10
+
+static int
+tc358746_link_validate(struct v4l2_subdev *sd, struct media_link *link,
+ struct v4l2_subdev_format *source_fmt,
+ struct v4l2_subdev_format *sink_fmt)
+{
+ struct tc358746 *tc358746 = to_tc358746(sd);
+ unsigned long csi_bitrate, sensor_bitrate;
+ const struct tc358746_format *fmt;
+ unsigned int fifo_sz, tmp, n;
+ s64 sensor_pclk_rate;
+
+ /* Check the FIFO settings */
+ fmt = tc358746_get_format_by_code(TC358746_SINK, tc358746->mbusfmt.code);
+ if (IS_ERR(fmt))
+ return PTR_ERR(fmt);
+
+ sensor_pclk_rate = v4l2_ctrl_g_ctrl_int64(tc358746->sensor_pclk_ctrl);
+ sensor_bitrate = sensor_pclk_rate * fmt->bus_width;
+
+ csi_bitrate = tc358746->dphy_cfg.lanes * tc358746->pll_rate;
+
+ dev_dbg(tc358746->sd.dev,
+ "Fifo settings params: sensor-bitrate:%lu csi-bitrate:%lu",
+ sensor_bitrate, csi_bitrate);
+
+ /* Avoid possible FIFO overflows */
+ if (csi_bitrate < sensor_bitrate) {
+ dev_err(sd->dev,
+ "Link validation failed csi-bitrate:%lu < sensor-bitrate:%lu\n",
+ csi_bitrate, sensor_bitrate);
+ return -EINVAL;
+ }
+
+ /* Best case */
+ if (csi_bitrate == sensor_bitrate) {
+ tc358746->vb_size = TC358746_VB_DEFAULT_SIZE;
+ goto out;
+ }
+
+ /*
+ * Avoid possible FIFO underflow in case of
+ * csi_bitrate > sensor_bitrate. For such case the chip has a internal
+ * fifo which can be used to delay the line output.
+ *
+ * Fifo size calculation:
+ *
+ * fifo-sz, image-width - in bits
+ * sbr - sensor_bitrate in bits/s
+ * csir - csi_bitrate in bits/s
+ *
+ * 1 1 1
+ * image-width * --- + fifo-sz --- >= ---- * image-width
+ * sbr sbr csir
+ *
+ * fifo-sz >= abs(sbr/csir * image-width - image-width)
+ * `-----´
+ * n
+ *
+ */
+
+ sensor_bitrate /= TC358746_PRECISION;
+ n = csi_bitrate / sensor_bitrate;
+ tmp = (tc358746->mbusfmt.width * TC358746_PRECISION) / n;
+ fifo_sz = tc358746->mbusfmt.width - tmp;
+ fifo_sz *= fmt->bpp;
+ tc358746->vb_size = round_up(fifo_sz, 32);
+
+out:
+ dev_dbg(tc358746->sd.dev,
+ "Found FIFO size[bits]:%u -> aligned to size[bits]:%u\n",
+ fifo_sz, tc358746->vb_size);
+
+ return tc358746->vb_size > TC358746_VB_MAX_SIZE ? -EINVAL : 0;
+}
+
+static int tc358746_get_mbus_config(struct v4l2_subdev *sd, unsigned int pad,
+ struct v4l2_mbus_config *config)
+{
+ struct tc358746 *tc358746 = to_tc358746(sd);
+
+ if (pad != TC358746_SOURCE)
+ return -EINVAL;
+
+ config->type = V4L2_MBUS_CSI2_DPHY;
+ config->bus.mipi_csi2 = tc358746->csi_vep.bus.mipi_csi2;
+
+ return 0;
+}
+
+static int tc358746_link_setup(struct media_entity *entity,
+ const struct media_pad *local,
+ const struct media_pad *remote, u32 flags)
+{
+ struct v4l2_subdev *sd = media_entity_to_v4l2_subdev(entity);
+ struct v4l2_subdev *sensor_sd =
+ media_entity_to_v4l2_subdev(remote->entity);
+ struct tc358746 *tc358746 = to_tc358746(sd);
+ struct device *dev = sd->dev;
+ struct v4l2_ctrl *ctrl;
+
+ /* no special requirements on source pads */
+ if (local->flags & MEDIA_PAD_FL_SOURCE)
+ return 0;
+
+ dev_dbg(dev, "link setup '%s':%d->'%s':%d[%d]",
+ remote->entity->name, remote->index, local->entity->name,
+ local->index, flags & MEDIA_LNK_FL_ENABLED);
+
+ /* Required for the fifo calculation */
+ ctrl = v4l2_ctrl_find(sensor_sd->ctrl_handler, V4L2_CID_PIXEL_RATE);
+ if (!ctrl) {
+ dev_err(dev, "Subdev [%s] must support V4L2_CID_PIXEL_RATE\n",
+ sensor_sd->name);
+ return -EINVAL;
+ }
+ tc358746->sensor_pclk_ctrl = ctrl;
+
+ return 0;
+}
+
+int __maybe_unused
+tc358746_g_register(struct v4l2_subdev *sd, struct v4l2_dbg_register *reg)
+{
+ struct tc358746 *tc358746 = to_tc358746(sd);
+
+ /* 32-bit registers starting from CLW_DPHYCONTTX */
+ reg->size = reg->reg < CLW_DPHYCONTTX_REG ? 2 : 4;
+
+ if (pm_runtime_resume_and_get(sd->dev)) {
+ dev_err(sd->dev, "Failed to resume the device\n");
+ return 0;
+ }
+
+ tc358746_read(tc358746, reg->reg, (u32 *)®->val);
+
+ pm_runtime_mark_last_busy(sd->dev);
+ pm_runtime_put_sync_autosuspend(sd->dev);
+
+ return 0;
+}
+
+int __maybe_unused
+tc358746_s_register(struct v4l2_subdev *sd, const struct v4l2_dbg_register *reg)
+{
+ struct tc358746 *tc358746 = to_tc358746(sd);
+
+ if (pm_runtime_resume_and_get(sd->dev)) {
+ dev_err(sd->dev, "Failed to resume the device\n");
+ return 0;
+ }
+
+ tc358746_write(tc358746, (u32)reg->reg, (u32)reg->val);
+
+ pm_runtime_mark_last_busy(sd->dev);
+ pm_runtime_put_sync_autosuspend(sd->dev);
+
+ return 0;
+}
+
+static const struct v4l2_subdev_core_ops tc358746_core_ops = {
+#ifdef CONFIG_VIDEO_ADV_DEBUG
+ .g_register = tc358746_g_register,
+ .s_register = tc358746_s_register,
+#endif
+};
+
+static const struct v4l2_subdev_video_ops tc358746_video_ops = {
+ .s_stream = tc358746_s_stream,
+};
+
+static const struct v4l2_subdev_pad_ops tc358746_pad_ops = {
+ .enum_mbus_code = tc358746_enum_mbus_code,
+ .set_fmt = tc358746_set_fmt,
+ .get_fmt = tc358746_get_fmt,
+ .link_validate = tc358746_link_validate,
+ .get_mbus_config = tc358746_get_mbus_config,
+};
+
+static const struct v4l2_subdev_ops tc358746_ops = {
+ .core = &tc358746_core_ops,
+ .video = &tc358746_video_ops,
+ .pad = &tc358746_pad_ops,
+};
+
+static const struct media_entity_operations tc358746_entity_ops = {
+ .get_fwnode_pad = v4l2_subdev_get_fwnode_pad_1_to_1,
+ .link_setup = tc358746_link_setup,
+ .link_validate = v4l2_subdev_link_validate,
+};
+
+static int tc358746_mclk_enable(struct clk_hw *hw)
+{
+ struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
+ unsigned int div;
+ u32 val;
+ int err;
+
+ div = tc358746->mclk_postdiv / 2;
+ val = MCLK_HIGH(div - 1) | MCLK_LOW(div - 1);
+ dev_dbg(tc358746->sd.dev, "MCLKCTL: %u (0x%x)\n", val, val);
+ err = tc358746_write(tc358746, MCLKCTL_REG, val);
+ if (err)
+ return err;
+
+ if (tc358746->mclk_prediv == 8)
+ val = MCLKDIV(MCLKDIV_8);
+ else if (tc358746->mclk_prediv == 4)
+ val = MCLKDIV(MCLKDIV_4);
+ else
+ val = MCLKDIV(MCLKDIV_2);
+
+ dev_dbg(tc358746->sd.dev, "CLKCTL[MCLKDIV]: %u (0x%x)\n", val, val);
+ return tc358746_update_bits(tc358746, CLKCTL_REG, MCLKDIV_MASK, val);
+}
+
+static void tc358746_mclk_disable(struct clk_hw *hw)
+{
+ struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
+
+ tc358746_write(tc358746, MCLKCTL_REG, 0);
+}
+
+static long
+tc358746_find_mclk_settings(struct tc358746 *tc358746, unsigned long mclk_rate)
+{
+ unsigned long pll_rate = tc358746->pll_rate;
+ const unsigned char prediv[] = { 2, 4, 8 };
+ unsigned int mclk_prediv, mclk_postdiv;
+ struct device *dev = tc358746->sd.dev;
+ unsigned int postdiv, mclkdiv;
+ unsigned long best_mclk_rate;
+ unsigned int i;
+
+ /*
+ * MCLK-Div
+ * -------------------´`---------------------
+ * ´ `
+ * +-------------+ +------------------------+
+ * | MCLK-PreDiv | | MCLK-PostDiv |
+ * PLL --> | (2/4/8) | --> | (mclk_low + mclk_high) | --> MCLK
+ * +-------------+ +------------------------+
+ *
+ * The register value of mclk_low/high is mclk_low/high+1, i.e.:
+ * mclk_low/high = 1 --> 2 MCLK-Ref Counts
+ * mclk_low/high = 255 --> 256 MCLK-Ref Counts == max.
+ * If mclk_low and mclk_high are 0 then MCLK is disabled.
+ *
+ * Keep it simple and support 50/50 duty cycles only for now,
+ * so the calc will be:
+ *
+ * MCLK = PLL / (MCLK-PreDiv * 2 * MCLK-PostDiv)
+ */
+
+ if (mclk_rate == tc358746->mclk_rate)
+ return mclk_rate;
+
+ /* Highest possible rate */
+ mclkdiv = pll_rate / mclk_rate;
+ if (mclkdiv <= 8) {
+ mclk_prediv = 2;
+ mclk_postdiv = 4;
+ best_mclk_rate = pll_rate / (2 * 4);
+ goto out;
+ }
+
+ /* First check the prediv */
+ for (i = 0; i < ARRAY_SIZE(prediv); i++) {
+ postdiv = mclkdiv / prediv[i];
+
+ if (postdiv % 2)
+ continue;
+
+ if (postdiv >= 4 && postdiv <= 512) {
+ mclk_prediv = prediv[i];
+ mclk_postdiv = postdiv;
+ best_mclk_rate = pll_rate / (prediv[i] * postdiv);
+ goto out;
+ }
+ }
+
+ /* No suitable prediv found, so try to adjust the postdiv */
+ for (postdiv = 4; postdiv <= 512; postdiv += 2) {
+ unsigned int pre;
+
+ pre = mclkdiv / postdiv;
+ if (pre == 2 || pre == 4 || pre == 8) {
+ mclk_prediv = pre;
+ mclk_postdiv = postdiv;
+ best_mclk_rate = pll_rate / (pre * postdiv);
+ goto out;
+ }
+ }
+
+ /* The MCLK <-> PLL gap is to high -> use largest possible div */
+ mclk_prediv = 8;
+ mclk_postdiv = 512;
+ best_mclk_rate = pll_rate / (8 * 512);
+
+out:
+ tc358746->mclk_prediv = mclk_prediv;
+ tc358746->mclk_postdiv = mclk_postdiv;
+ tc358746->mclk_rate = best_mclk_rate;
+
+ if (best_mclk_rate != mclk_rate)
+ dev_warn(dev, "Request MCLK freq:%lu, found MCLK freq:%lu\n",
+ mclk_rate, best_mclk_rate);
+
+ dev_dbg(dev, "Found MCLK settings: freq:%lu prediv:%u postdiv:%u\n",
+ best_mclk_rate, mclk_prediv, mclk_postdiv);
+
+ return best_mclk_rate;
+}
+
+unsigned long tc358746_recalc_rate(struct clk_hw *hw, unsigned long parent_rate)
+{
+ struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
+ unsigned int prediv, postdiv;
+ u32 val;
+ int err;
+
+ err = tc358746_read(tc358746, MCLKCTL_REG, &val);
+ if (err)
+ return 0;
+
+ postdiv = FIELD_GET(MCLK_LOW_MASK, val) + 1;
+ postdiv += FIELD_GET(MCLK_HIGH_MASK, val) + 1;
+
+ err = tc358746_read(tc358746, CLKCTL_REG, &val);
+ if (err)
+ return 0;
+
+ prediv = FIELD_GET(MCLKDIV_MASK, val);
+ if (prediv == MCLKDIV_8)
+ prediv = 8;
+ else if (prediv == MCLKDIV_4)
+ prediv = 4;
+ else
+ prediv = 2;
+
+ return tc358746->pll_rate / (prediv * postdiv);
+}
+
+static long tc358746_mclk_round_rate(struct clk_hw *hw, unsigned long rate,
+ unsigned long *parent_rate)
+{
+ struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
+
+ *parent_rate = tc358746->pll_rate;
+
+ return tc358746_find_mclk_settings(tc358746, rate);
+}
+
+static int tc358746_mclk_set_rate(struct clk_hw *hw, unsigned long rate,
+ unsigned long parent_rate)
+{
+ struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
+
+ tc358746_find_mclk_settings(tc358746, rate);
+
+ return tc358746_mclk_enable(hw);
+}
+
+static const struct clk_ops tc358746_mclk_ops = {
+ .enable = tc358746_mclk_enable,
+ .disable = tc358746_mclk_disable,
+ .recalc_rate = tc358746_recalc_rate,
+ .round_rate = tc358746_mclk_round_rate,
+ .set_rate = tc358746_mclk_set_rate,
+};
+
+static int tc358746_notify_bound(struct v4l2_async_notifier *notifier,
+ struct v4l2_subdev *sd,
+ struct v4l2_async_subdev *asd)
+{
+ struct tc358746 *tc358746 =
+ container_of(notifier, struct tc358746, notifier);
+ struct media_pad *sink = &tc358746->pads[TC358746_SINK];
+
+ return v4l2_create_fwnode_links_to_pad(sd, sink, MEDIA_LNK_FL_ENABLED);
+}
+
+static const struct v4l2_async_notifier_operations tc358746_notify_ops = {
+ .bound = tc358746_notify_bound,
+};
+
+static int tc358746_async_register(struct tc358746 *tc358746)
+{
+ struct v4l2_fwnode_endpoint vep = {
+ .bus_type = V4L2_MBUS_PARALLEL,
+ };
+ struct v4l2_async_subdev *asd;
+ struct fwnode_handle *ep;
+ int err;
+
+ ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(tc358746->sd.dev),
+ TC358746_SINK, 0, 0);
+ if (!ep)
+ return -ENOTCONN;
+
+ err = v4l2_fwnode_endpoint_parse(ep, &vep);
+ if (err) {
+ fwnode_handle_put(ep);
+ return err;
+ }
+
+ v4l2_async_nf_init(&tc358746->notifier);
+ asd = v4l2_async_nf_add_fwnode_remote(&tc358746->notifier, ep,
+ struct v4l2_async_subdev);
+ if (IS_ERR(asd)) {
+ fwnode_handle_put(ep);
+ return PTR_ERR(asd);
+ }
+
+ fwnode_handle_put(ep);
+
+ tc358746->notifier.ops = &tc358746_notify_ops;
+
+ err = v4l2_async_subdev_nf_register(&tc358746->sd, &tc358746->notifier);
+ if (err) {
+ v4l2_async_nf_cleanup(&tc358746->notifier);
+ return err;
+ }
+
+ tc358746->sd.fwnode = fwnode_graph_get_endpoint_by_id(
+ dev_fwnode(tc358746->sd.dev), TC358746_SOURCE, 0, 0);
+
+ err = v4l2_async_register_subdev(&tc358746->sd);
+ if (err) {
+ v4l2_async_nf_unregister(&tc358746->notifier);
+ v4l2_async_nf_cleanup(&tc358746->notifier);
+ }
+
+ return err;
+}
+
+static int tc358746_probe(struct i2c_client *client)
+{
+ struct clk_init_data mclk_initdata = { };
+ struct device *dev = &client->dev;
+ struct v4l2_fwnode_endpoint *vep;
+ unsigned long csi_link_rate;
+ struct tc358746 *tc358746;
+ struct fwnode_handle *ep;
+ unsigned char csi_lanes;
+ struct v4l2_subdev *sd;
+ struct v4l2_ctrl *ctrl;
+ unsigned long refclk;
+ unsigned int i;
+ int err;
+ u32 val;
+
+ tc358746 = devm_kzalloc(&client->dev, sizeof(*tc358746), GFP_KERNEL);
+ if (!tc358746)
+ return -ENOMEM;
+
+ tc358746->regmap = devm_regmap_init_i2c(client, &tc358746_regmap_config);
+ if (IS_ERR(tc358746->regmap))
+ return dev_err_probe(dev, PTR_ERR(tc358746->regmap),
+ "Failed to init regmap\n");
+
+ tc358746->refclk = devm_clk_get(dev, "refclk");
+ if (IS_ERR(tc358746->refclk))
+ return dev_err_probe(dev, PTR_ERR(tc358746->refclk),
+ "Failed to get refclk\n");
+
+ err = clk_prepare_enable(tc358746->refclk);
+ if (err)
+ return dev_err_probe(dev, err,
+ "Failed to enable refclk\n");
+
+ refclk = clk_get_rate(tc358746->refclk);
+ clk_disable_unprepare(tc358746->refclk);
+
+ if (refclk < 6 * MHZ || refclk > 40 * MHZ)
+ return dev_err_probe(dev, -EINVAL, "Invalid refclk range\n");
+
+ for (i = 0; i < ARRAY_SIZE(tc358746_supplies); i++)
+ tc358746->supplies[i].supply = tc358746_supplies[i];
+
+ err = devm_regulator_bulk_get(dev, ARRAY_SIZE(tc358746_supplies),
+ tc358746->supplies);
+ if (err)
+ return dev_err_probe(dev, err, "Failed to get supplies\n");
+
+ tc358746->reset_gpio = devm_gpiod_get_optional(dev, "reset",
+ GPIOD_OUT_HIGH);
+ if (IS_ERR(tc358746->reset_gpio))
+ return dev_err_probe(dev, PTR_ERR(tc358746->reset_gpio),
+ "Failed to get reset-gpios\n");
+
+ sd = &tc358746->sd;
+ v4l2_i2c_subdev_init(sd, client, &tc358746_ops);
+ sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
+ sd->entity.function = MEDIA_ENT_F_VID_IF_BRIDGE;
+ sd->entity.ops = &tc358746_entity_ops;
+
+ tc358746->pads[TC358746_SINK].flags = MEDIA_PAD_FL_SINK;
+ tc358746->pads[TC358746_SOURCE].flags = MEDIA_PAD_FL_SOURCE;
+ err = media_entity_pads_init(&sd->entity, TC358746_NR_PADS,
+ tc358746->pads);
+ if (err)
+ return dev_err_probe(dev, err,
+ "Failed to setup media-entity pads\n");
+
+ ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(dev), TC358746_SOURCE,
+ 0, 0);
+ if (!ep) {
+ dev_err(dev, "Missing endpoint node\n");
+ err = -EINVAL;
+ goto err_mc;
+ }
+
+ /* Currently we only support 'parallel in' -> 'csi out' */
+ vep = &tc358746->csi_vep;
+ vep->bus_type = V4L2_MBUS_CSI2_DPHY;
+ err = v4l2_fwnode_endpoint_alloc_parse(ep, vep);
+ fwnode_handle_put(ep);
+ if (err) {
+ dev_err(dev, "Failed to parse source endpoint\n");
+ goto err_mc;
+ }
+
+ csi_lanes = vep->bus.mipi_csi2.num_data_lanes;
+ if (csi_lanes == 0 || csi_lanes > 4 ||
+ vep->nr_of_link_frequencies == 0) {
+ dev_err(dev, "error: Invalid CSI-2 settings\n");
+ err = -EINVAL;
+ goto err_vep;
+ }
+
+ /* TODO: Add support to handle multiple link frequencies */
+ csi_link_rate = (unsigned long)vep->link_frequencies[0];
+ tc358746->pll_rate = tc358746_find_pll_settings(tc358746, refclk,
+ csi_link_rate * 2);
+ if (!tc358746->pll_rate) {
+ err = -EINVAL;
+ goto err_vep;
+ }
+
+ err = phy_mipi_dphy_get_default_config_for_hsclk(tc358746->pll_rate,
+ csi_lanes,
+ &tc358746->dphy_cfg);
+ if (err)
+ goto err_vep;
+
+ tc358746->mbusfmt = tc358746_def_fmt;
+ tc358746->vb_size = TC358746_VB_DEFAULT_SIZE;
+
+ dev_set_drvdata(dev, tc358746);
+ pm_runtime_set_autosuspend_delay(dev, 200);
+ pm_runtime_use_autosuspend(dev);
+ pm_runtime_enable(dev);
+
+ err = pm_runtime_resume_and_get(dev);
+ if (err < 0) {
+ dev_err(dev, "Failed to resume the device\n");
+ goto err_vep;
+ }
+
+ /* Ensure that CSI interface is put into LP-11 state */
+ err = tc358746_sw_reset(tc358746);
+ if (err) {
+ pm_runtime_put_noidle(dev);
+ dev_err(dev, "Failed to reset the device\n");
+ goto err_pm;
+ }
+
+ err = tc358746_read(tc358746, CHIPID_REG, &val);
+ pm_runtime_mark_last_busy(dev);
+ pm_runtime_put_sync_autosuspend(dev);
+ if (err) {
+ dev_err(dev, "Failed to read chipid\n");
+ err = -ENODEV;
+ goto err_pm;
+ }
+
+ if (FIELD_GET(CHIPID, val) != 0x44) {
+ dev_err(dev, "Invalid chipid 0x%02x\n",
+ (u32)FIELD_GET(CHIPID, val));
+ err = -ENODEV;
+ goto err_pm;
+ }
+
+ /* Optional MCLK provider support */
+ if (device_property_present(dev, "#clock-cells")) {
+ const char *mclk_name;
+
+ /* Init to highest possibel MCLK */
+ tc358746->mclk_postdiv = 512;
+ tc358746->mclk_prediv = 8;
+
+ mclk_name = "tc358746-mclk";
+ device_property_read_string(dev, "clock-output-names",
+ &mclk_name);
+
+ mclk_initdata.name = mclk_name;
+ mclk_initdata.ops = &tc358746_mclk_ops;
+ tc358746->mclk_hw.init = &mclk_initdata;
+
+ err = devm_clk_hw_register(dev, &tc358746->mclk_hw);
+ if (err) {
+ dev_err(dev, "Failed to register mclk provider\n");
+ goto err_pm;
+ }
+
+ err = devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get,
+ &tc358746->mclk_hw);
+ if (err) {
+ dev_err(dev, "Failed to add mclk provider\n");
+ goto err_pm;
+ }
+ }
+
+ v4l2_ctrl_handler_init(&tc358746->ctrl_hdl, 1);
+
+ ctrl = v4l2_ctrl_new_int_menu(&tc358746->ctrl_hdl, NULL,
+ V4L2_CID_LINK_FREQ, 0, 0,
+ vep->link_frequencies);
+ if (ctrl)
+ ctrl->flags |= V4L2_CTRL_FLAG_READ_ONLY;
+
+ tc358746->sd.ctrl_handler = &tc358746->ctrl_hdl;
+ if (tc358746->ctrl_hdl.error) {
+ err = tc358746->ctrl_hdl.error;
+ goto err_pm;
+ }
+
+ v4l2_ctrl_handler_setup(&tc358746->ctrl_hdl);
+
+ err = tc358746_async_register(tc358746);
+ if (err < 0)
+ goto err_ctrl;
+
+ dev_info(dev, "%s found @ 0x%x (%s)\n", client->name,
+ client->addr, client->adapter->name);
+
+ return 0;
+
+err_ctrl:
+ v4l2_ctrl_handler_free(&tc358746->ctrl_hdl);
+err_pm:
+ pm_runtime_disable(dev);
+ pm_runtime_set_suspended(dev);
+ pm_runtime_dont_use_autosuspend(dev);
+err_vep:
+ v4l2_fwnode_endpoint_free(vep);
+err_mc:
+ media_entity_cleanup(&sd->entity);
+
+ return err;
+}
+
+static int tc358746_remove(struct i2c_client *client)
+{
+ struct v4l2_subdev *sd = i2c_get_clientdata(client);
+ struct tc358746 *tc358746 = to_tc358746(sd);
+
+ v4l2_ctrl_handler_free(&tc358746->ctrl_hdl);
+ v4l2_fwnode_endpoint_free(&tc358746->csi_vep);
+ v4l2_async_nf_unregister(&tc358746->notifier);
+ v4l2_async_nf_cleanup(&tc358746->notifier);
+ v4l2_async_unregister_subdev(sd);
+ v4l2_device_unregister_subdev(sd);
+ media_entity_cleanup(&sd->entity);
+
+ pm_runtime_disable(sd->dev);
+ pm_runtime_set_suspended(sd->dev);
+ pm_runtime_dont_use_autosuspend(sd->dev);
+
+ return 0;
+}
+
+static int tc358746_suspend(struct device *dev)
+{
+ struct tc358746 *tc358746 = dev_get_drvdata(dev);
+
+ clk_disable_unprepare(tc358746->refclk);
+
+ return regulator_bulk_disable(ARRAY_SIZE(tc358746_supplies),
+ tc358746->supplies);
+}
+
+static int tc358746_resume(struct device *dev)
+{
+ struct tc358746 *tc358746 = dev_get_drvdata(dev);
+ int err;
+
+ gpiod_set_value(tc358746->reset_gpio, 1);
+
+ err = regulator_bulk_enable(ARRAY_SIZE(tc358746_supplies),
+ tc358746->supplies);
+ if (err)
+ return err;
+
+ /* min. 200ns */
+ usleep_range(10, 20);
+
+ gpiod_set_value(tc358746->reset_gpio, 0);
+
+ err = clk_prepare_enable(tc358746->refclk);
+ if (err)
+ return err;
+
+ /* min. 700us ... 1ms */
+ usleep_range(1000, 1500);
+
+ /* Sync state */
+ err = tc358746_apply_pll_config(tc358746);
+ if (err)
+ return err;
+
+ err = tc358746_apply_dphy_config(tc358746);
+ if (err)
+ return err;
+
+ return tc358746_apply_misc_config(tc358746);
+}
+
+DEFINE_RUNTIME_DEV_PM_OPS(tc358746_pm_ops, tc358746_suspend,
+ tc358746_resume, NULL);
+
+static const struct of_device_id __maybe_unused tc358746_of_match[] = {
+ { .compatible = "toshiba,tc358746" },
+ { },
+};
+MODULE_DEVICE_TABLE(of, tc358746_of_match);
+
+static struct i2c_driver tc358746_driver = {
+ .driver = {
+ .name = "tc358746",
+ .pm = pm_ptr(&tc358746_pm_ops),
+ .of_match_table = tc358746_of_match,
+ },
+ .probe_new = tc358746_probe,
+ .remove = tc358746_remove,
+};
+
+module_i2c_driver(tc358746_driver);
+
+MODULE_DESCRIPTION("Toshiba TC358746 Parallel to CSI-2 bridge driver");
+MODULE_AUTHOR("Marco Felsch <kernel@pengutronix.de>");
+MODULE_LICENSE("GPL");
--
2.30.2
^ permalink raw reply related [flat|nested] 34+ messages in thread
* [PATCH 4/4] media: tc358746: add Toshiba TC358746 Parallel to CSI-2 bridge driver
@ 2022-08-18 14:33 ` Marco Felsch
0 siblings, 0 replies; 34+ messages in thread
From: Marco Felsch @ 2022-08-18 14:33 UTC (permalink / raw)
To: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, laurent.pinchart+renesas
Cc: linux-kernel, linux-phy, devicetree, linux-media, kernel
Adding support for the TC358746 parallel <-> MIPI CSI bridge. This chip
supports two operating modes:
1st) parallel-in -> mipi-csi out
2nd) mipi-csi in -> parallel out
This patch only adds the support for the 1st mode.
Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
---
drivers/media/i2c/Kconfig | 17 +
drivers/media/i2c/Makefile | 1 +
drivers/media/i2c/tc358746.c | 1645 ++++++++++++++++++++++++++++++++++
3 files changed, 1663 insertions(+)
create mode 100644 drivers/media/i2c/tc358746.c
diff --git a/drivers/media/i2c/Kconfig b/drivers/media/i2c/Kconfig
index 7806d4b81716..aefb9c9e0c08 100644
--- a/drivers/media/i2c/Kconfig
+++ b/drivers/media/i2c/Kconfig
@@ -1272,6 +1272,23 @@ config VIDEO_TC358743_CEC
When selected the tc358743 will support the optional
HDMI CEC feature.
+config VIDEO_TC358746
+ tristate "Toshiba TC358746 parallel-CSI2 bridge"
+ depends on VIDEO_DEV && I2C
+ select VIDEO_V4L2_SUBDEV_API
+ select MEDIA_CONTROLLER
+ select V4L2_FWNODE
+ select GENERIC_PHY_MIPI_DPHY
+ select REGMAP_I2C
+ select COMMON_CLK
+ help
+ Support for the Toshiba TC358746 parallel to MIPI CSI-2 bridge.
+ The bridge can work in both directions but currently only the
+ parallel-in / csi-out path is supported.
+
+ To compile this driver as a module, choose M here: the
+ module will be called tc358746.
+
config VIDEO_TVP514X
tristate "Texas Instruments TVP514x video decoder"
depends on VIDEO_DEV && I2C
diff --git a/drivers/media/i2c/Makefile b/drivers/media/i2c/Makefile
index 0a2933103dd9..d1096c2ab480 100644
--- a/drivers/media/i2c/Makefile
+++ b/drivers/media/i2c/Makefile
@@ -118,6 +118,7 @@ obj-$(CONFIG_VIDEO_SONY_BTF_MPX) += sony-btf-mpx.o
obj-$(CONFIG_VIDEO_SR030PC30) += sr030pc30.o
obj-$(CONFIG_VIDEO_ST_MIPID02) += st-mipid02.o
obj-$(CONFIG_VIDEO_TC358743) += tc358743.o
+obj-$(CONFIG_VIDEO_TC358746) += tc358746.o
obj-$(CONFIG_VIDEO_TDA1997X) += tda1997x.o
obj-$(CONFIG_VIDEO_TDA7432) += tda7432.o
obj-$(CONFIG_VIDEO_TDA9840) += tda9840.o
diff --git a/drivers/media/i2c/tc358746.c b/drivers/media/i2c/tc358746.c
new file mode 100644
index 000000000000..7b71d0cf72a9
--- /dev/null
+++ b/drivers/media/i2c/tc358746.c
@@ -0,0 +1,1645 @@
+// SPDX-License-Identifier: GPL-2.0-only
+/*
+ * TC358746 - Parallel <-> CSI-2 Bridge
+ *
+ * Copyright 2022 Marco Felsch <kernel@pengutronix.de>
+ *
+ * Notes:
+ * - Currently only 'Parallel-in -> CSI-out' mode is supported!
+ */
+
+#include <linux/bitfield.h>
+#include <linux/clk.h>
+#include <linux/clk-provider.h>
+#include <linux/delay.h>
+#include <linux/i2c.h>
+#include <linux/interrupt.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/phy/phy-mipi-dphy.h>
+#include <linux/property.h>
+#include <linux/pm_runtime.h>
+#include <linux/regmap.h>
+#include <media/v4l2-ctrls.h>
+#include <media/v4l2-device.h>
+#include <media/v4l2-fwnode.h>
+#include <media/v4l2-mc.h>
+
+/* 16-bit registers */
+#define CHIPID_REG 0x0000
+#define CHIPID GENMASK(15, 8)
+
+#define SYSCTL_REG 0x0002
+#define SRESET BIT(0)
+
+#define CONFCTL_REG 0x0004
+#define PDATAF_MASK GENMASK(9, 8)
+#define PDATAF_MODE0 0
+#define PDATAF_MODE1 1
+#define PDATAF_MODE2 2
+#define PDATAF(val) FIELD_PREP(PDATAF_MASK, (val))
+#define PPEN BIT(6)
+#define DATALANE_MASK GENMASK(1, 0)
+
+#define FIFOCTL_REG 0x0006
+#define DATAFMT_REG 0x0008
+#define PDFMT(val) FIELD_PREP(GENMASK(7, 4), (val))
+
+#define MCLKCTL_REG 0x000c
+#define MCLK_HIGH_MASK GENMASK(15, 8)
+#define MCLK_LOW_MASK GENMASK(7, 0)
+#define MCLK_HIGH(val) FIELD_PREP(MCLK_HIGH_MASK, (val))
+#define MCLK_LOW(val) FIELD_PREP(MCLK_LOW_MASK, (val))
+
+#define PLLCTL0_REG 0x0016
+#define PLL_PRD_MASK GENMASK(15, 12)
+#define PLL_PRD(val) FIELD_PREP(PLL_PRD_MASK, (val))
+#define PLL_FBD_MASK GENMASK(8, 0)
+#define PLL_FBD(val) FIELD_PREP(PLL_FBD_MASK, (val))
+
+#define PLLCTL1_REG 0x0018
+#define PLL_FRS_MASK GENMASK(11, 10)
+#define PLL_FRS(val) FIELD_PREP(PLL_FRS_MASK, (val))
+#define CKEN BIT(4)
+#define RESETB BIT(1)
+#define PLL_EN BIT(0)
+
+#define CLKCTL_REG 0x0020
+#define MCLKDIV_MASK GENMASK(3, 2)
+#define MCLKDIV(val) FIELD_PREP(MCLKDIV_MASK, (val))
+#define MCLKDIV_8 0
+#define MCLKDIV_4 1
+#define MCLKDIV_2 2
+
+#define WORDCNT_REG 0x0022
+#define PP_MISC_REG 0x0032
+#define FRMSTOP BIT(15)
+#define RSTPTR BIT(14)
+
+/* 32-bit registers */
+#define CLW_DPHYCONTTX_REG 0x0100
+#define CLW_CNTRL_REG 0x0140
+#define D0W_CNTRL_REG 0x0144
+#define LANEDISABLE BIT(0)
+
+#define STARTCNTRL_REG 0x0204
+#define START BIT(0)
+
+#define LINEINITCNT_REG 0x0210
+#define LPTXTIMECNT_REG 0x0214
+#define TCLK_HEADERCNT_REG 0x0218
+#define TCLK_ZEROCNT(val) FIELD_PREP(GENMASK(15, 8), (val))
+#define TCLK_PREPARECNT(val) FIELD_PREP(GENMASK(6, 0), (val))
+
+#define TCLK_TRAILCNT_REG 0x021C
+#define THS_HEADERCNT_REG 0x0220
+#define THS_ZEROCNT(val) FIELD_PREP(GENMASK(14, 8), (val))
+#define THS_PREPARECNT(val) FIELD_PREP(GENMASK(6, 0), (val))
+
+#define TWAKEUP_REG 0x0224
+#define TCLK_POSTCNT_REG 0x0228
+#define THS_TRAILCNT_REG 0x022C
+#define HSTXVREGEN_REG 0x0234
+#define TXOPTIONCNTRL_REG 0x0238
+#define CSI_CONTROL_REG 0x040C
+#define CSI_MODE BIT(15)
+#define TXHSMD BIT(7)
+#define NOL(val) FIELD_PREP(GENMASK(2, 1), (val))
+
+#define CSI_CONFW_REG 0x0500
+#define MODE(val) FIELD_PREP(GENMASK(31, 29), (val))
+#define MODE_SET 0x5
+#define ADDRESS(val) FIELD_PREP(GENMASK(28, 24), (val))
+#define CSI_CONTROL_ADDRESS 0x3
+#define DATA(val) FIELD_PREP(GENMASK(15, 0), (val))
+
+#define CSI_START_REG 0x0518
+#define STRT BIT(0)
+
+static const struct v4l2_mbus_framefmt tc358746_def_fmt = {
+ .width = 640,
+ .height = 480,
+ .code = MEDIA_BUS_FMT_UYVY8_2X8,
+ .field = V4L2_FIELD_NONE,
+ .colorspace = V4L2_COLORSPACE_DEFAULT,
+ .ycbcr_enc = V4L2_YCBCR_ENC_DEFAULT,
+ .quantization = V4L2_QUANTIZATION_DEFAULT,
+ .xfer_func = V4L2_XFER_FUNC_DEFAULT,
+};
+
+static const char * const tc358746_supplies[] = {
+ "vddc", "vddio", "vddmipi"
+};
+
+enum {
+ TC358746_SINK,
+ TC358746_SOURCE,
+ TC358746_NR_PADS
+};
+
+struct tc358746 {
+ struct v4l2_subdev sd;
+ struct media_pad pads[TC358746_NR_PADS];
+ struct v4l2_async_notifier notifier;
+ struct v4l2_mbus_framefmt mbusfmt;
+ struct v4l2_fwnode_endpoint csi_vep;
+
+ struct v4l2_ctrl_handler ctrl_hdl;
+
+ struct regmap *regmap;
+ struct clk *refclk;
+ struct gpio_desc *reset_gpio;
+ struct regulator_bulk_data supplies[ARRAY_SIZE(tc358746_supplies)];
+
+ struct clk_hw mclk_hw;
+ unsigned long mclk_rate;
+ u8 mclk_prediv;
+ u16 mclk_postdiv;
+
+ unsigned long pll_rate;
+ u8 pll_post_div;
+ u16 pll_pre_div;
+ u16 pll_mul;
+
+ struct v4l2_ctrl *sensor_pclk_ctrl;
+
+#define TC358746_VB_MAX_SIZE (511 * 32)
+#define TC358746_VB_DEFAULT_SIZE (1 * 32)
+ unsigned int vb_size; /* Video buffer size in bits */
+
+ struct phy_configure_opts_mipi_dphy dphy_cfg;
+};
+
+static inline struct tc358746 *to_tc358746(struct v4l2_subdev *sd)
+{
+ return container_of(sd, struct tc358746, sd);
+}
+
+static inline struct tc358746 *clk_hw_to_tc358746(struct clk_hw *hw)
+{
+ return container_of(hw, struct tc358746, mclk_hw);
+}
+
+struct tc358746_format {
+ u32 code;
+ bool csi_format;
+ unsigned char bus_width;
+ unsigned char bpp;
+ /* Register values */
+ u8 pdformat; /* Peripheral Data Format */
+ u8 pdataf; /* Parallel Data Format Option */
+};
+
+enum {
+ PDFORMAT_RAW8 = 0,
+ PDFORMAT_RAW10,
+ PDFORMAT_RAW12,
+ PDFORMAT_RGB888,
+ PDFORMAT_RGB666,
+ PDFORMAT_RGB565,
+ PDFORMAT_YUV422_8BIT,
+ /* RESERVED = 7 */
+ PDFORMAT_RAW14 = 8,
+ PDFORMAT_YUV422_10BIT,
+ PDFORMAT_YUV444,
+};
+
+/* Check tc358746_src_mbus_code() if you add new formats */
+static const struct tc358746_format tc358746_formats[] = {
+ {
+ .code = MEDIA_BUS_FMT_UYVY8_2X8,
+ .bus_width = 8,
+ .bpp = 16,
+ .pdformat = PDFORMAT_YUV422_8BIT,
+ .pdataf = PDATAF_MODE0,
+ }, {
+ .code = MEDIA_BUS_FMT_UYVY8_1X16,
+ .csi_format = true,
+ .bus_width = 16,
+ .bpp = 16,
+ .pdformat = PDFORMAT_YUV422_8BIT,
+ .pdataf = PDATAF_MODE1,
+ }, {
+ .code = MEDIA_BUS_FMT_YUYV8_1X16,
+ .csi_format = true,
+ .bus_width = 16,
+ .bpp = 16,
+ .pdformat = PDFORMAT_YUV422_8BIT,
+ .pdataf = PDATAF_MODE2,
+ }, {
+ .code = MEDIA_BUS_FMT_UYVY10_2X10,
+ .bus_width = 10,
+ .bpp = 20,
+ .pdformat = PDFORMAT_YUV422_10BIT,
+ .pdataf = PDATAF_MODE0, /* don't care */
+ }, {
+ /* in datasheet listed as YUV444 */
+ .code = MEDIA_BUS_FMT_GBR888_1X24,
+ .csi_format = true,
+ .bus_width = 24,
+ .bpp = 24,
+ .pdformat = PDFORMAT_YUV444,
+ .pdataf = PDATAF_MODE0, /* don't care */
+ },
+};
+
+/* Get n-th format for pad */
+static const struct tc358746_format *
+tc358746_get_format_by_idx(unsigned int pad, unsigned int index)
+{
+ unsigned int idx = 0;
+ unsigned int i;
+
+ if (pad >= TC358746_NR_PADS)
+ return ERR_PTR(-EINVAL);
+
+ for (i = 0; i < ARRAY_SIZE(tc358746_formats); i++) {
+ const struct tc358746_format *fmt = &tc358746_formats[i];
+
+ if ((pad == TC358746_SOURCE && fmt->csi_format) ||
+ (pad == TC358746_SINK)) {
+ if (idx == index)
+ return fmt;
+ idx++;
+ }
+ }
+
+ return ERR_PTR(-EINVAL);
+}
+
+static const struct tc358746_format *
+tc358746_get_format_by_code(unsigned int pad, u32 code)
+{
+ unsigned int i;
+
+ if (pad >= TC358746_NR_PADS)
+ return ERR_PTR(-EINVAL);
+
+ for (i = 0; i < ARRAY_SIZE(tc358746_formats); i++) {
+ const struct tc358746_format *fmt = &tc358746_formats[i];
+
+ if (pad == TC358746_SINK && fmt->code == code)
+ return fmt;
+
+ if (pad == TC358746_SOURCE && fmt->csi_format &&
+ fmt->code == code)
+ return fmt;
+ }
+
+ return ERR_PTR(-EINVAL);
+}
+
+static u32 tc358746_src_mbus_code(u32 code)
+{
+ switch (code) {
+ case MEDIA_BUS_FMT_UYVY8_2X8:
+ return MEDIA_BUS_FMT_UYVY8_1X16;
+ case MEDIA_BUS_FMT_UYVY10_2X10:
+ return MEDIA_BUS_FMT_UYVY10_1X20;
+ default:
+ return code;
+ }
+}
+
+static bool tc358746_writeable_reg(struct device *dev, unsigned int reg)
+{
+ switch (reg) {
+ case SYSCTL_REG ... CSI_START_REG:
+ return true;
+ default:
+ return false;
+ }
+}
+
+static bool tc358746_readable_reg(struct device *dev, unsigned int reg)
+{
+ switch (reg) {
+ case CHIPID_REG ... CSI_START_REG:
+ return true;
+ default:
+ return false;
+ }
+}
+
+static const struct regmap_config tc358746_regmap_config = {
+ .name = "tc358746",
+ .reg_bits = 16,
+ .val_bits = 16,
+ .max_register = CSI_START_REG,
+ .writeable_reg = tc358746_writeable_reg,
+ .readable_reg = tc358746_readable_reg,
+ .reg_format_endian = REGMAP_ENDIAN_BIG,
+ .val_format_endian = REGMAP_ENDIAN_BIG,
+};
+
+static int tc358746_write(struct tc358746 *tc358746, u32 reg, u32 val)
+{
+ size_t count;
+
+ /* 32-bit registers starting from CLW_DPHYCONTTX */
+ count = reg < CLW_DPHYCONTTX_REG ? 1 : 2;
+
+ return regmap_bulk_write(tc358746->regmap, reg, &val, count);
+}
+
+static int tc358746_read(struct tc358746 *tc358746, u32 reg, u32 *val)
+{
+ size_t count;
+
+ /* 32-bit registers starting from CLW_DPHYCONTTX */
+ count = reg < CLW_DPHYCONTTX_REG ? 1 : 2;
+ *val = 0;
+
+ return regmap_bulk_read(tc358746->regmap, reg, val, count);
+}
+
+static int
+tc358746_update_bits(struct tc358746 *tc358746, u32 reg, u32 mask, u32 val)
+{
+ u32 tmp, orig;
+ int err;
+
+ err = tc358746_read(tc358746, reg, &orig);
+ if (err)
+ return err;
+
+ tmp = orig & ~mask;
+ tmp |= val & mask;
+
+ return tc358746_write(tc358746, reg, tmp);
+}
+
+static int tc358746_set_bits(struct tc358746 *tc358746, u32 reg, u32 bits)
+{
+ return tc358746_update_bits(tc358746, reg, bits, bits);
+}
+
+static int tc358746_clear_bits(struct tc358746 *tc358746, u32 reg, u32 bits)
+{
+ return tc358746_update_bits(tc358746, reg, bits, 0);
+}
+
+static int tc358746_sw_reset(struct tc358746 *tc358746)
+{
+ int err;
+
+ err = tc358746_set_bits(tc358746, SYSCTL_REG, SRESET);
+ if (err)
+ return err;
+
+ udelay(10);
+
+ return tc358746_clear_bits(tc358746, SYSCTL_REG, SRESET);
+}
+
+static int
+tc358746_apply_pll_config(struct tc358746 *tc358746)
+{
+ u8 post = tc358746->pll_post_div;
+ u16 pre = tc358746->pll_pre_div;
+ u16 mul = tc358746->pll_mul;
+ u32 val, mask;
+ int err;
+
+ err = tc358746_read(tc358746, PLLCTL1_REG, &val);
+ if (err)
+ return err;
+
+ /* Don't touch the PLL if running */
+ if (FIELD_GET(PLL_EN, val) == 1)
+ return 0;
+
+ /* Pre-div and Multiplicator have a internal +1 logic */
+ val = PLL_PRD(pre - 1) | PLL_FBD(mul - 1);
+ mask = PLL_PRD_MASK | PLL_FBD_MASK;
+ err = tc358746_update_bits(tc358746, PLLCTL0_REG, mask, val);
+ if (err)
+ return err;
+
+ val = PLL_FRS(ilog2(post)) | RESETB | PLL_EN;
+ mask = PLL_FRS_MASK | RESETB | PLL_EN;
+ tc358746_update_bits(tc358746, PLLCTL1_REG, mask, val);
+ if (err)
+ return err;
+
+ udelay(1000);
+
+ return tc358746_set_bits(tc358746, PLLCTL1_REG, CKEN);
+}
+
+static int tc358746_apply_misc_config(struct tc358746 *tc358746)
+{
+ struct device *dev = tc358746->sd.dev;
+ const struct tc358746_format *fmt;
+ u32 val;
+ int err;
+
+ fmt = tc358746_get_format_by_code(TC358746_SINK, tc358746->mbusfmt.code);
+ if (IS_ERR(fmt))
+ return PTR_ERR(fmt);
+
+ /* Self defined CSI user data type id's are not supported yet */
+ val = PDFMT(fmt->pdformat);
+ dev_dbg(dev, "DATAFMT: 0x%x\n", val);
+ err = tc358746_write(tc358746, DATAFMT_REG, val);
+ if (err)
+ return err;
+
+ val = PDATAF(fmt->pdataf);
+ dev_dbg(dev, "CONFCTL[PDATAF]: 0x%x\n", fmt->pdataf);
+ err = tc358746_update_bits(tc358746, CONFCTL_REG, PDATAF_MASK, val);
+ if (err)
+ return err;
+
+ val = tc358746->vb_size / 32;
+ dev_dbg(dev, "FIFOCTL: %u (0x%x)\n", val, val);
+ err = tc358746_write(tc358746, FIFOCTL_REG, val);
+ if (err)
+ return err;
+
+ /* Total number of bytes for each line/width */
+ val = tc358746->mbusfmt.width * fmt->bpp / 8;
+ dev_dbg(dev, "WORDCNT: %u (0x%x)\n", val, val);
+ return tc358746_write(tc358746, WORDCNT_REG, val);
+}
+
+#ifndef MHZ
+#define MHZ (1000 * 1000)
+#endif
+
+/* Use MHz as base so the div needs no u64 */
+static u32 tc358746_cfg_to_cnt(unsigned int cfg_val,
+ unsigned int clk_mhz,
+ unsigned int time_base)
+{
+ return DIV_ROUND_UP(cfg_val * clk_mhz, time_base);
+}
+
+static u32 tc358746_ps_to_cnt(unsigned int cfg_val,
+ unsigned int clk_mhz)
+{
+ return tc358746_cfg_to_cnt(cfg_val, clk_mhz, USEC_PER_SEC);
+}
+
+static u32 tc358746_us_to_cnt(unsigned int cfg_val,
+ unsigned int clk_mhz)
+{
+ return tc358746_cfg_to_cnt(cfg_val, clk_mhz, 1);
+}
+
+static int tc358746_apply_dphy_config(struct tc358746 *tc358746)
+{
+ struct phy_configure_opts_mipi_dphy *cfg = &tc358746->dphy_cfg;
+ bool non_cont_clk = !!(tc358746->csi_vep.bus.mipi_csi2.flags &
+ V4L2_MBUS_CSI2_NONCONTINUOUS_CLOCK);
+ struct device *dev = tc358746->sd.dev;
+ unsigned long hs_byte_clk, hf_clk;
+ u32 val, val2, lptxcnt;
+ int err;
+
+ /* The hs_byte_clk is also called SYSCLK in the excel sheet */
+ hs_byte_clk = cfg->hs_clk_rate / 8;
+ hs_byte_clk /= MHZ;
+ hf_clk = hs_byte_clk / 2;
+
+ val = tc358746_us_to_cnt(cfg->init, hf_clk) - 1;
+ dev_dbg(dev, "LINEINITCNT: %u (0x%x)\n", val, val);
+ err = tc358746_write(tc358746, LINEINITCNT_REG, val);
+ if (err)
+ return err;
+
+ val = tc358746_ps_to_cnt(cfg->lpx, hs_byte_clk) - 1;
+ lptxcnt = val;
+ dev_dbg(dev, "LPTXTIMECNT: %u (0x%x)\n", val, val);
+ err = tc358746_write(tc358746, LPTXTIMECNT_REG, val);
+ if (err)
+ return err;
+
+ val = tc358746_ps_to_cnt(cfg->clk_prepare, hs_byte_clk) - 1;
+ val2 = tc358746_ps_to_cnt(cfg->clk_zero, hs_byte_clk) - 1;
+ dev_dbg(dev, "TCLK_PREPARECNT: %u (0x%x)\n", val, val);
+ dev_dbg(dev, "TCLK_ZEROCNT: %u (0x%x)\n", val2, val2);
+ dev_dbg(dev, "TCLK_HEADERCNT: 0x%x\n",
+ (u32)(TCLK_PREPARECNT(val) | TCLK_ZEROCNT(val2)));
+ err = tc358746_write(tc358746, TCLK_HEADERCNT_REG,
+ TCLK_PREPARECNT(val) | TCLK_ZEROCNT(val2));
+ if (err)
+ return err;
+
+ val = tc358746_ps_to_cnt(cfg->clk_trail, hs_byte_clk);
+ dev_dbg(dev, "TCLK_TRAILCNT: %u (0x%x)\n", val, val);
+ err = tc358746_write(tc358746, TCLK_TRAILCNT_REG, val);
+ if (err)
+ return err;
+
+ val = tc358746_ps_to_cnt(cfg->hs_prepare, hs_byte_clk) - 1;
+ val2 = tc358746_ps_to_cnt(cfg->hs_zero, hs_byte_clk) - 1;
+ dev_dbg(dev, "THS_PREPARECNT: %u (0x%x)\n", val, val);
+ dev_dbg(dev, "THS_ZEROCNT: %u (0x%x)\n", val2, val2);
+ dev_dbg(dev, "THS_HEADERCNT: 0x%x\n",
+ (u32)(THS_PREPARECNT(val) | THS_ZEROCNT(val2)));
+ err = tc358746_write(tc358746, THS_HEADERCNT_REG,
+ THS_PREPARECNT(val) | THS_ZEROCNT(val2));
+ if (err)
+ return err;
+
+ /* TWAKEUP > 1ms in lptxcnt steps */
+ val = tc358746_us_to_cnt(cfg->wakeup, hs_byte_clk);
+ val = val / (lptxcnt + 1) - 1;
+ dev_dbg(dev, "TWAKEUP: %u (0x%x)\n", val, val);
+ err = tc358746_write(tc358746, TWAKEUP_REG, val);
+ if (err)
+ return err;
+
+ val = tc358746_ps_to_cnt(cfg->clk_post, hs_byte_clk);
+ dev_dbg(dev, "TCLK_POSTCNT: %u (0x%x)\n", val, val);
+ err = tc358746_write(tc358746, TCLK_POSTCNT_REG, val);
+ if (err)
+ return err;
+
+ val = tc358746_ps_to_cnt(cfg->hs_trail, hs_byte_clk);
+ dev_dbg(dev, "THS_TRAILCNT: %u (0x%x)\n", val, val);
+ err = tc358746_write(tc358746, THS_TRAILCNT_REG, val);
+ if (err)
+ return err;
+
+ dev_dbg(dev, "CONTCLKMODE: %u", non_cont_clk ? 0 : 1);
+ return tc358746_write(tc358746, TXOPTIONCNTRL_REG, non_cont_clk ? 0 : 1);
+}
+
+#define MAX_DATA_LANES 4
+
+static int tc358746_enable_csi_lanes(struct tc358746 *tc358746, int enable)
+{
+ unsigned int lanes = tc358746->dphy_cfg.lanes;
+ unsigned int lane;
+ u32 reg, val;
+ int err;
+
+ err = tc358746_update_bits(tc358746, CONFCTL_REG, DATALANE_MASK,
+ lanes - 1);
+ if (err)
+ return err;
+
+ /* Clock lane */
+ val = enable ? 0 : LANEDISABLE;
+ dev_dbg(tc358746->sd.dev, "CLW_CNTRL: 0x%x\n", val);
+ err = tc358746_write(tc358746, CLW_CNTRL_REG, val);
+ if (err)
+ return err;
+
+ for (lane = 0; lane < MAX_DATA_LANES; lane++) {
+ /* Data lanes */
+ reg = D0W_CNTRL_REG + lane * 0x4;
+ val = (enable && lane < lanes) ? 0 : LANEDISABLE;
+
+ dev_dbg(tc358746->sd.dev, "D%uW_CNTRL: 0x%x\n", lane, val);
+ err = tc358746_write(tc358746, reg, val);
+ if (err)
+ return err;
+ }
+
+ val = 0;
+ if (enable) {
+ /* Clock lane */
+ val |= BIT(0);
+
+ /* Data lanes */
+ for (lane = 1; lane <= lanes; lane++)
+ val |= BIT(lane);
+ }
+
+ dev_dbg(tc358746->sd.dev, "HSTXVREGEN: 0x%x\n", val);
+ return tc358746_write(tc358746, HSTXVREGEN_REG, val);
+}
+
+static int tc358746_enable_csi_module(struct tc358746 *tc358746, int enable)
+{
+ unsigned int lanes = tc358746->dphy_cfg.lanes;
+ int err;
+
+ /*
+ * START and STRT are only reseted/disabled by sw reset. This is
+ * required to put the lane state back into LP-11 state. The sw reset
+ * don't reset register values.
+ */
+ if (!enable)
+ return tc358746_sw_reset(tc358746);
+
+ err = tc358746_write(tc358746, STARTCNTRL_REG, START);
+ if (err)
+ return err;
+
+ err = tc358746_write(tc358746, CSI_START_REG, STRT);
+ if (err)
+ return err;
+
+ /* CSI_CONTROL_REG is only indirect accessible */
+ return tc358746_write(tc358746, CSI_CONFW_REG,
+ MODE(MODE_SET) |
+ ADDRESS(CSI_CONTROL_ADDRESS) |
+ DATA(CSI_MODE | TXHSMD | NOL(lanes - 1)));
+}
+
+static int tc358746_enable_parallel_port(struct tc358746 *tc358746, int enable)
+{
+ int err;
+
+ if (enable) {
+ err = tc358746_write(tc358746, PP_MISC_REG, 0);
+ if (err)
+ return err;
+
+ return tc358746_set_bits(tc358746, CONFCTL_REG, PPEN);
+ }
+
+ err = tc358746_set_bits(tc358746, PP_MISC_REG, FRMSTOP);
+ if (err)
+ return err;
+
+ err = tc358746_clear_bits(tc358746, CONFCTL_REG, PPEN);
+ if (err)
+ return err;
+
+ return tc358746_set_bits(tc358746, PP_MISC_REG, RSTPTR);
+}
+
+static inline struct v4l2_subdev *tc358746_get_remote_sd(struct media_pad *pad)
+{
+ pad = media_pad_remote_pad_first(pad);
+ if (!pad)
+ return NULL;
+
+ return media_entity_to_v4l2_subdev(pad->entity);
+}
+
+static int tc358746_s_stream(struct v4l2_subdev *sd, int enable)
+{
+ struct tc358746 *tc358746 = to_tc358746(sd);
+ struct v4l2_subdev *src;
+ int err;
+
+ dev_dbg(sd->dev, "%sable\n", enable ? "en" : "dis");
+
+ src = tc358746_get_remote_sd(&tc358746->pads[TC358746_SINK]);
+ if (!src)
+ return -EPIPE;
+
+ if (enable) {
+ err = pm_runtime_resume_and_get(sd->dev);
+ if (err)
+ return err;
+
+ err = tc358746_enable_csi_lanes(tc358746, 1);
+ if (err) {
+ pm_runtime_mark_last_busy(sd->dev);
+ pm_runtime_put_sync_autosuspend(sd->dev);
+ return err;
+ }
+
+ err = tc358746_enable_csi_module(tc358746, 1);
+ if (err) {
+ pm_runtime_mark_last_busy(sd->dev);
+ pm_runtime_put_sync_autosuspend(sd->dev);
+ return err;
+ }
+
+ err = tc358746_enable_parallel_port(tc358746, 1);
+ if (err) {
+ pm_runtime_mark_last_busy(sd->dev);
+ pm_runtime_put_sync_autosuspend(sd->dev);
+ return err;
+ }
+
+ err = v4l2_subdev_call(src, video, s_stream, 1);
+ if (err) {
+ pm_runtime_mark_last_busy(sd->dev);
+ pm_runtime_put_sync_autosuspend(sd->dev);
+ }
+
+ return err;
+ }
+
+ /*
+ * Lane disable trigger state change from LP-11 to LP-00
+ * therefore it must happen before the CSI modile is disabled.
+ */
+ err = tc358746_enable_csi_lanes(tc358746, 0);
+ if (err)
+ return err;
+
+ err = tc358746_enable_csi_module(tc358746, 0);
+ if (err)
+ return err;
+
+ err = tc358746_enable_parallel_port(tc358746, 0);
+ if (err)
+ return err;
+
+ pm_runtime_mark_last_busy(sd->dev);
+ pm_runtime_put_sync_autosuspend(sd->dev);
+
+ return v4l2_subdev_call(src, video, s_stream, 0);
+}
+
+static int tc358746_enum_mbus_code(struct v4l2_subdev *sd,
+ struct v4l2_subdev_state *sd_state,
+ struct v4l2_subdev_mbus_code_enum *code)
+{
+ const struct tc358746_format *fmt;
+
+ fmt = tc358746_get_format_by_idx(code->pad, code->index);
+ if (IS_ERR(fmt))
+ return PTR_ERR(fmt);
+
+ code->code = fmt->code;
+
+ return 0;
+}
+
+static struct v4l2_mbus_framefmt *
+__tc358746_get_pad_format(struct v4l2_subdev *sd,
+ struct v4l2_subdev_state *sd_state,
+ unsigned int pad, u32 which)
+{
+ struct tc358746 *tc358746 = to_tc358746(sd);
+
+ switch (which) {
+ case V4L2_SUBDEV_FORMAT_TRY:
+ return v4l2_subdev_get_try_format(sd, sd_state, pad);
+ case V4L2_SUBDEV_FORMAT_ACTIVE:
+ return &tc358746->mbusfmt;
+ default:
+ return NULL;
+ }
+}
+
+static int tc358746_get_fmt(struct v4l2_subdev *sd,
+ struct v4l2_subdev_state *sd_state,
+ struct v4l2_subdev_format *format)
+{
+ struct tc358746 *tc358746 = to_tc358746(sd);
+
+ if (format->pad >= TC358746_NR_PADS)
+ return -EINVAL;
+
+ format->format = tc358746->mbusfmt;
+ if (format->pad == TC358746_SOURCE)
+ format->format.code = tc358746_src_mbus_code(tc358746->mbusfmt.code);
+
+ return 0;
+}
+
+static int tc358746_set_fmt(struct v4l2_subdev *sd,
+ struct v4l2_subdev_state *sd_state,
+ struct v4l2_subdev_format *format)
+{
+ struct v4l2_mbus_framefmt *mbusformat;
+ const struct tc358746_format *fmt;
+
+ if (format->pad >= TC358746_NR_PADS)
+ return -EINVAL;
+
+ /* The src follows the properties from the sink */
+ if (format->pad == TC358746_SOURCE)
+ return tc358746_get_fmt(sd, sd_state, format);
+
+ mbusformat = __tc358746_get_pad_format(sd, sd_state, format->pad,
+ format->which);
+ if (!mbusformat)
+ return -EINVAL;
+
+ fmt = tc358746_get_format_by_code(format->pad, format->format.code);
+ if (IS_ERR(fmt))
+ fmt = tc358746_get_format_by_code(format->pad, tc358746_def_fmt.code);
+
+ format->format.code = fmt->code;
+ format->format.field = V4L2_FIELD_NONE;
+
+ dev_dbg(sd->dev, "Update format: %ux%u code:0x%x -> %ux%u code:0x%x",
+ mbusformat->width, mbusformat->height, mbusformat->code,
+ format->format.width, format->format.height, format->format.code);
+
+ *mbusformat = format->format;
+
+ return 0;
+}
+
+static unsigned long tc358746_find_pll_settings(struct tc358746 *tc358746,
+ unsigned long refclk,
+ unsigned long fout)
+
+{
+ struct device *dev = tc358746->sd.dev;
+ unsigned long best_freq = 0;
+ u32 min_delta = 0xffffffff;
+ u16 prediv_max = 17;
+ u16 prediv_min = 1;
+ u16 m_best, mul;
+ u16 p_best, p;
+ u8 postdiv;
+
+ if (fout > 1000 * MHZ) {
+ dev_err(dev, "HS-Clock above 1 Ghz are not supported\n");
+ return 0;
+ } else if (fout >= 500 * MHZ)
+ postdiv = 1;
+ else if (fout >= 250 * MHZ)
+ postdiv = 2;
+ else if (fout >= 125 * MHZ)
+ postdiv = 4;
+ else
+ postdiv = 8;
+
+ for (p = prediv_min; p <= prediv_max; p++) {
+ unsigned long delta, fin;
+ u64 tmp;
+
+ fin = DIV_ROUND_CLOSEST(refclk, p);
+ if (fin < 4 * MHZ || fin > 40 * MHZ)
+ continue;
+
+ tmp = fout * p * postdiv;
+ do_div(tmp, fin);
+ mul = tmp;
+ if (mul > 511)
+ continue;
+
+ tmp = mul * fin;
+ do_div(tmp, p * postdiv);
+
+ delta = abs(fout - tmp);
+ if (delta < min_delta) {
+ p_best = p;
+ m_best = mul;
+ min_delta = delta;
+ best_freq = tmp;
+ };
+
+ if (delta == 0)
+ break;
+ };
+
+ if (!best_freq) {
+ dev_err(dev, "Failed find PLL frequency\n");
+ return 0;
+ }
+
+ tc358746->pll_post_div = postdiv;
+ tc358746->pll_pre_div = p_best;
+ tc358746->pll_mul = m_best;
+
+ if (best_freq != fout)
+ dev_warn(dev, "Request PLL freq:%lu, found PLL freq:%lu\n",
+ fout, best_freq);
+
+ dev_dbg(dev, "Found PLL settings: freq:%lu prediv:%u multi:%u postdiv:%u\n",
+ best_freq, p_best, m_best, postdiv);
+
+ return best_freq;
+}
+
+#define TC358746_PRECISION 10
+
+static int
+tc358746_link_validate(struct v4l2_subdev *sd, struct media_link *link,
+ struct v4l2_subdev_format *source_fmt,
+ struct v4l2_subdev_format *sink_fmt)
+{
+ struct tc358746 *tc358746 = to_tc358746(sd);
+ unsigned long csi_bitrate, sensor_bitrate;
+ const struct tc358746_format *fmt;
+ unsigned int fifo_sz, tmp, n;
+ s64 sensor_pclk_rate;
+
+ /* Check the FIFO settings */
+ fmt = tc358746_get_format_by_code(TC358746_SINK, tc358746->mbusfmt.code);
+ if (IS_ERR(fmt))
+ return PTR_ERR(fmt);
+
+ sensor_pclk_rate = v4l2_ctrl_g_ctrl_int64(tc358746->sensor_pclk_ctrl);
+ sensor_bitrate = sensor_pclk_rate * fmt->bus_width;
+
+ csi_bitrate = tc358746->dphy_cfg.lanes * tc358746->pll_rate;
+
+ dev_dbg(tc358746->sd.dev,
+ "Fifo settings params: sensor-bitrate:%lu csi-bitrate:%lu",
+ sensor_bitrate, csi_bitrate);
+
+ /* Avoid possible FIFO overflows */
+ if (csi_bitrate < sensor_bitrate) {
+ dev_err(sd->dev,
+ "Link validation failed csi-bitrate:%lu < sensor-bitrate:%lu\n",
+ csi_bitrate, sensor_bitrate);
+ return -EINVAL;
+ }
+
+ /* Best case */
+ if (csi_bitrate == sensor_bitrate) {
+ tc358746->vb_size = TC358746_VB_DEFAULT_SIZE;
+ goto out;
+ }
+
+ /*
+ * Avoid possible FIFO underflow in case of
+ * csi_bitrate > sensor_bitrate. For such case the chip has a internal
+ * fifo which can be used to delay the line output.
+ *
+ * Fifo size calculation:
+ *
+ * fifo-sz, image-width - in bits
+ * sbr - sensor_bitrate in bits/s
+ * csir - csi_bitrate in bits/s
+ *
+ * 1 1 1
+ * image-width * --- + fifo-sz --- >= ---- * image-width
+ * sbr sbr csir
+ *
+ * fifo-sz >= abs(sbr/csir * image-width - image-width)
+ * `-----´
+ * n
+ *
+ */
+
+ sensor_bitrate /= TC358746_PRECISION;
+ n = csi_bitrate / sensor_bitrate;
+ tmp = (tc358746->mbusfmt.width * TC358746_PRECISION) / n;
+ fifo_sz = tc358746->mbusfmt.width - tmp;
+ fifo_sz *= fmt->bpp;
+ tc358746->vb_size = round_up(fifo_sz, 32);
+
+out:
+ dev_dbg(tc358746->sd.dev,
+ "Found FIFO size[bits]:%u -> aligned to size[bits]:%u\n",
+ fifo_sz, tc358746->vb_size);
+
+ return tc358746->vb_size > TC358746_VB_MAX_SIZE ? -EINVAL : 0;
+}
+
+static int tc358746_get_mbus_config(struct v4l2_subdev *sd, unsigned int pad,
+ struct v4l2_mbus_config *config)
+{
+ struct tc358746 *tc358746 = to_tc358746(sd);
+
+ if (pad != TC358746_SOURCE)
+ return -EINVAL;
+
+ config->type = V4L2_MBUS_CSI2_DPHY;
+ config->bus.mipi_csi2 = tc358746->csi_vep.bus.mipi_csi2;
+
+ return 0;
+}
+
+static int tc358746_link_setup(struct media_entity *entity,
+ const struct media_pad *local,
+ const struct media_pad *remote, u32 flags)
+{
+ struct v4l2_subdev *sd = media_entity_to_v4l2_subdev(entity);
+ struct v4l2_subdev *sensor_sd =
+ media_entity_to_v4l2_subdev(remote->entity);
+ struct tc358746 *tc358746 = to_tc358746(sd);
+ struct device *dev = sd->dev;
+ struct v4l2_ctrl *ctrl;
+
+ /* no special requirements on source pads */
+ if (local->flags & MEDIA_PAD_FL_SOURCE)
+ return 0;
+
+ dev_dbg(dev, "link setup '%s':%d->'%s':%d[%d]",
+ remote->entity->name, remote->index, local->entity->name,
+ local->index, flags & MEDIA_LNK_FL_ENABLED);
+
+ /* Required for the fifo calculation */
+ ctrl = v4l2_ctrl_find(sensor_sd->ctrl_handler, V4L2_CID_PIXEL_RATE);
+ if (!ctrl) {
+ dev_err(dev, "Subdev [%s] must support V4L2_CID_PIXEL_RATE\n",
+ sensor_sd->name);
+ return -EINVAL;
+ }
+ tc358746->sensor_pclk_ctrl = ctrl;
+
+ return 0;
+}
+
+int __maybe_unused
+tc358746_g_register(struct v4l2_subdev *sd, struct v4l2_dbg_register *reg)
+{
+ struct tc358746 *tc358746 = to_tc358746(sd);
+
+ /* 32-bit registers starting from CLW_DPHYCONTTX */
+ reg->size = reg->reg < CLW_DPHYCONTTX_REG ? 2 : 4;
+
+ if (pm_runtime_resume_and_get(sd->dev)) {
+ dev_err(sd->dev, "Failed to resume the device\n");
+ return 0;
+ }
+
+ tc358746_read(tc358746, reg->reg, (u32 *)®->val);
+
+ pm_runtime_mark_last_busy(sd->dev);
+ pm_runtime_put_sync_autosuspend(sd->dev);
+
+ return 0;
+}
+
+int __maybe_unused
+tc358746_s_register(struct v4l2_subdev *sd, const struct v4l2_dbg_register *reg)
+{
+ struct tc358746 *tc358746 = to_tc358746(sd);
+
+ if (pm_runtime_resume_and_get(sd->dev)) {
+ dev_err(sd->dev, "Failed to resume the device\n");
+ return 0;
+ }
+
+ tc358746_write(tc358746, (u32)reg->reg, (u32)reg->val);
+
+ pm_runtime_mark_last_busy(sd->dev);
+ pm_runtime_put_sync_autosuspend(sd->dev);
+
+ return 0;
+}
+
+static const struct v4l2_subdev_core_ops tc358746_core_ops = {
+#ifdef CONFIG_VIDEO_ADV_DEBUG
+ .g_register = tc358746_g_register,
+ .s_register = tc358746_s_register,
+#endif
+};
+
+static const struct v4l2_subdev_video_ops tc358746_video_ops = {
+ .s_stream = tc358746_s_stream,
+};
+
+static const struct v4l2_subdev_pad_ops tc358746_pad_ops = {
+ .enum_mbus_code = tc358746_enum_mbus_code,
+ .set_fmt = tc358746_set_fmt,
+ .get_fmt = tc358746_get_fmt,
+ .link_validate = tc358746_link_validate,
+ .get_mbus_config = tc358746_get_mbus_config,
+};
+
+static const struct v4l2_subdev_ops tc358746_ops = {
+ .core = &tc358746_core_ops,
+ .video = &tc358746_video_ops,
+ .pad = &tc358746_pad_ops,
+};
+
+static const struct media_entity_operations tc358746_entity_ops = {
+ .get_fwnode_pad = v4l2_subdev_get_fwnode_pad_1_to_1,
+ .link_setup = tc358746_link_setup,
+ .link_validate = v4l2_subdev_link_validate,
+};
+
+static int tc358746_mclk_enable(struct clk_hw *hw)
+{
+ struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
+ unsigned int div;
+ u32 val;
+ int err;
+
+ div = tc358746->mclk_postdiv / 2;
+ val = MCLK_HIGH(div - 1) | MCLK_LOW(div - 1);
+ dev_dbg(tc358746->sd.dev, "MCLKCTL: %u (0x%x)\n", val, val);
+ err = tc358746_write(tc358746, MCLKCTL_REG, val);
+ if (err)
+ return err;
+
+ if (tc358746->mclk_prediv == 8)
+ val = MCLKDIV(MCLKDIV_8);
+ else if (tc358746->mclk_prediv == 4)
+ val = MCLKDIV(MCLKDIV_4);
+ else
+ val = MCLKDIV(MCLKDIV_2);
+
+ dev_dbg(tc358746->sd.dev, "CLKCTL[MCLKDIV]: %u (0x%x)\n", val, val);
+ return tc358746_update_bits(tc358746, CLKCTL_REG, MCLKDIV_MASK, val);
+}
+
+static void tc358746_mclk_disable(struct clk_hw *hw)
+{
+ struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
+
+ tc358746_write(tc358746, MCLKCTL_REG, 0);
+}
+
+static long
+tc358746_find_mclk_settings(struct tc358746 *tc358746, unsigned long mclk_rate)
+{
+ unsigned long pll_rate = tc358746->pll_rate;
+ const unsigned char prediv[] = { 2, 4, 8 };
+ unsigned int mclk_prediv, mclk_postdiv;
+ struct device *dev = tc358746->sd.dev;
+ unsigned int postdiv, mclkdiv;
+ unsigned long best_mclk_rate;
+ unsigned int i;
+
+ /*
+ * MCLK-Div
+ * -------------------´`---------------------
+ * ´ `
+ * +-------------+ +------------------------+
+ * | MCLK-PreDiv | | MCLK-PostDiv |
+ * PLL --> | (2/4/8) | --> | (mclk_low + mclk_high) | --> MCLK
+ * +-------------+ +------------------------+
+ *
+ * The register value of mclk_low/high is mclk_low/high+1, i.e.:
+ * mclk_low/high = 1 --> 2 MCLK-Ref Counts
+ * mclk_low/high = 255 --> 256 MCLK-Ref Counts == max.
+ * If mclk_low and mclk_high are 0 then MCLK is disabled.
+ *
+ * Keep it simple and support 50/50 duty cycles only for now,
+ * so the calc will be:
+ *
+ * MCLK = PLL / (MCLK-PreDiv * 2 * MCLK-PostDiv)
+ */
+
+ if (mclk_rate == tc358746->mclk_rate)
+ return mclk_rate;
+
+ /* Highest possible rate */
+ mclkdiv = pll_rate / mclk_rate;
+ if (mclkdiv <= 8) {
+ mclk_prediv = 2;
+ mclk_postdiv = 4;
+ best_mclk_rate = pll_rate / (2 * 4);
+ goto out;
+ }
+
+ /* First check the prediv */
+ for (i = 0; i < ARRAY_SIZE(prediv); i++) {
+ postdiv = mclkdiv / prediv[i];
+
+ if (postdiv % 2)
+ continue;
+
+ if (postdiv >= 4 && postdiv <= 512) {
+ mclk_prediv = prediv[i];
+ mclk_postdiv = postdiv;
+ best_mclk_rate = pll_rate / (prediv[i] * postdiv);
+ goto out;
+ }
+ }
+
+ /* No suitable prediv found, so try to adjust the postdiv */
+ for (postdiv = 4; postdiv <= 512; postdiv += 2) {
+ unsigned int pre;
+
+ pre = mclkdiv / postdiv;
+ if (pre == 2 || pre == 4 || pre == 8) {
+ mclk_prediv = pre;
+ mclk_postdiv = postdiv;
+ best_mclk_rate = pll_rate / (pre * postdiv);
+ goto out;
+ }
+ }
+
+ /* The MCLK <-> PLL gap is to high -> use largest possible div */
+ mclk_prediv = 8;
+ mclk_postdiv = 512;
+ best_mclk_rate = pll_rate / (8 * 512);
+
+out:
+ tc358746->mclk_prediv = mclk_prediv;
+ tc358746->mclk_postdiv = mclk_postdiv;
+ tc358746->mclk_rate = best_mclk_rate;
+
+ if (best_mclk_rate != mclk_rate)
+ dev_warn(dev, "Request MCLK freq:%lu, found MCLK freq:%lu\n",
+ mclk_rate, best_mclk_rate);
+
+ dev_dbg(dev, "Found MCLK settings: freq:%lu prediv:%u postdiv:%u\n",
+ best_mclk_rate, mclk_prediv, mclk_postdiv);
+
+ return best_mclk_rate;
+}
+
+unsigned long tc358746_recalc_rate(struct clk_hw *hw, unsigned long parent_rate)
+{
+ struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
+ unsigned int prediv, postdiv;
+ u32 val;
+ int err;
+
+ err = tc358746_read(tc358746, MCLKCTL_REG, &val);
+ if (err)
+ return 0;
+
+ postdiv = FIELD_GET(MCLK_LOW_MASK, val) + 1;
+ postdiv += FIELD_GET(MCLK_HIGH_MASK, val) + 1;
+
+ err = tc358746_read(tc358746, CLKCTL_REG, &val);
+ if (err)
+ return 0;
+
+ prediv = FIELD_GET(MCLKDIV_MASK, val);
+ if (prediv == MCLKDIV_8)
+ prediv = 8;
+ else if (prediv == MCLKDIV_4)
+ prediv = 4;
+ else
+ prediv = 2;
+
+ return tc358746->pll_rate / (prediv * postdiv);
+}
+
+static long tc358746_mclk_round_rate(struct clk_hw *hw, unsigned long rate,
+ unsigned long *parent_rate)
+{
+ struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
+
+ *parent_rate = tc358746->pll_rate;
+
+ return tc358746_find_mclk_settings(tc358746, rate);
+}
+
+static int tc358746_mclk_set_rate(struct clk_hw *hw, unsigned long rate,
+ unsigned long parent_rate)
+{
+ struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
+
+ tc358746_find_mclk_settings(tc358746, rate);
+
+ return tc358746_mclk_enable(hw);
+}
+
+static const struct clk_ops tc358746_mclk_ops = {
+ .enable = tc358746_mclk_enable,
+ .disable = tc358746_mclk_disable,
+ .recalc_rate = tc358746_recalc_rate,
+ .round_rate = tc358746_mclk_round_rate,
+ .set_rate = tc358746_mclk_set_rate,
+};
+
+static int tc358746_notify_bound(struct v4l2_async_notifier *notifier,
+ struct v4l2_subdev *sd,
+ struct v4l2_async_subdev *asd)
+{
+ struct tc358746 *tc358746 =
+ container_of(notifier, struct tc358746, notifier);
+ struct media_pad *sink = &tc358746->pads[TC358746_SINK];
+
+ return v4l2_create_fwnode_links_to_pad(sd, sink, MEDIA_LNK_FL_ENABLED);
+}
+
+static const struct v4l2_async_notifier_operations tc358746_notify_ops = {
+ .bound = tc358746_notify_bound,
+};
+
+static int tc358746_async_register(struct tc358746 *tc358746)
+{
+ struct v4l2_fwnode_endpoint vep = {
+ .bus_type = V4L2_MBUS_PARALLEL,
+ };
+ struct v4l2_async_subdev *asd;
+ struct fwnode_handle *ep;
+ int err;
+
+ ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(tc358746->sd.dev),
+ TC358746_SINK, 0, 0);
+ if (!ep)
+ return -ENOTCONN;
+
+ err = v4l2_fwnode_endpoint_parse(ep, &vep);
+ if (err) {
+ fwnode_handle_put(ep);
+ return err;
+ }
+
+ v4l2_async_nf_init(&tc358746->notifier);
+ asd = v4l2_async_nf_add_fwnode_remote(&tc358746->notifier, ep,
+ struct v4l2_async_subdev);
+ if (IS_ERR(asd)) {
+ fwnode_handle_put(ep);
+ return PTR_ERR(asd);
+ }
+
+ fwnode_handle_put(ep);
+
+ tc358746->notifier.ops = &tc358746_notify_ops;
+
+ err = v4l2_async_subdev_nf_register(&tc358746->sd, &tc358746->notifier);
+ if (err) {
+ v4l2_async_nf_cleanup(&tc358746->notifier);
+ return err;
+ }
+
+ tc358746->sd.fwnode = fwnode_graph_get_endpoint_by_id(
+ dev_fwnode(tc358746->sd.dev), TC358746_SOURCE, 0, 0);
+
+ err = v4l2_async_register_subdev(&tc358746->sd);
+ if (err) {
+ v4l2_async_nf_unregister(&tc358746->notifier);
+ v4l2_async_nf_cleanup(&tc358746->notifier);
+ }
+
+ return err;
+}
+
+static int tc358746_probe(struct i2c_client *client)
+{
+ struct clk_init_data mclk_initdata = { };
+ struct device *dev = &client->dev;
+ struct v4l2_fwnode_endpoint *vep;
+ unsigned long csi_link_rate;
+ struct tc358746 *tc358746;
+ struct fwnode_handle *ep;
+ unsigned char csi_lanes;
+ struct v4l2_subdev *sd;
+ struct v4l2_ctrl *ctrl;
+ unsigned long refclk;
+ unsigned int i;
+ int err;
+ u32 val;
+
+ tc358746 = devm_kzalloc(&client->dev, sizeof(*tc358746), GFP_KERNEL);
+ if (!tc358746)
+ return -ENOMEM;
+
+ tc358746->regmap = devm_regmap_init_i2c(client, &tc358746_regmap_config);
+ if (IS_ERR(tc358746->regmap))
+ return dev_err_probe(dev, PTR_ERR(tc358746->regmap),
+ "Failed to init regmap\n");
+
+ tc358746->refclk = devm_clk_get(dev, "refclk");
+ if (IS_ERR(tc358746->refclk))
+ return dev_err_probe(dev, PTR_ERR(tc358746->refclk),
+ "Failed to get refclk\n");
+
+ err = clk_prepare_enable(tc358746->refclk);
+ if (err)
+ return dev_err_probe(dev, err,
+ "Failed to enable refclk\n");
+
+ refclk = clk_get_rate(tc358746->refclk);
+ clk_disable_unprepare(tc358746->refclk);
+
+ if (refclk < 6 * MHZ || refclk > 40 * MHZ)
+ return dev_err_probe(dev, -EINVAL, "Invalid refclk range\n");
+
+ for (i = 0; i < ARRAY_SIZE(tc358746_supplies); i++)
+ tc358746->supplies[i].supply = tc358746_supplies[i];
+
+ err = devm_regulator_bulk_get(dev, ARRAY_SIZE(tc358746_supplies),
+ tc358746->supplies);
+ if (err)
+ return dev_err_probe(dev, err, "Failed to get supplies\n");
+
+ tc358746->reset_gpio = devm_gpiod_get_optional(dev, "reset",
+ GPIOD_OUT_HIGH);
+ if (IS_ERR(tc358746->reset_gpio))
+ return dev_err_probe(dev, PTR_ERR(tc358746->reset_gpio),
+ "Failed to get reset-gpios\n");
+
+ sd = &tc358746->sd;
+ v4l2_i2c_subdev_init(sd, client, &tc358746_ops);
+ sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
+ sd->entity.function = MEDIA_ENT_F_VID_IF_BRIDGE;
+ sd->entity.ops = &tc358746_entity_ops;
+
+ tc358746->pads[TC358746_SINK].flags = MEDIA_PAD_FL_SINK;
+ tc358746->pads[TC358746_SOURCE].flags = MEDIA_PAD_FL_SOURCE;
+ err = media_entity_pads_init(&sd->entity, TC358746_NR_PADS,
+ tc358746->pads);
+ if (err)
+ return dev_err_probe(dev, err,
+ "Failed to setup media-entity pads\n");
+
+ ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(dev), TC358746_SOURCE,
+ 0, 0);
+ if (!ep) {
+ dev_err(dev, "Missing endpoint node\n");
+ err = -EINVAL;
+ goto err_mc;
+ }
+
+ /* Currently we only support 'parallel in' -> 'csi out' */
+ vep = &tc358746->csi_vep;
+ vep->bus_type = V4L2_MBUS_CSI2_DPHY;
+ err = v4l2_fwnode_endpoint_alloc_parse(ep, vep);
+ fwnode_handle_put(ep);
+ if (err) {
+ dev_err(dev, "Failed to parse source endpoint\n");
+ goto err_mc;
+ }
+
+ csi_lanes = vep->bus.mipi_csi2.num_data_lanes;
+ if (csi_lanes == 0 || csi_lanes > 4 ||
+ vep->nr_of_link_frequencies == 0) {
+ dev_err(dev, "error: Invalid CSI-2 settings\n");
+ err = -EINVAL;
+ goto err_vep;
+ }
+
+ /* TODO: Add support to handle multiple link frequencies */
+ csi_link_rate = (unsigned long)vep->link_frequencies[0];
+ tc358746->pll_rate = tc358746_find_pll_settings(tc358746, refclk,
+ csi_link_rate * 2);
+ if (!tc358746->pll_rate) {
+ err = -EINVAL;
+ goto err_vep;
+ }
+
+ err = phy_mipi_dphy_get_default_config_for_hsclk(tc358746->pll_rate,
+ csi_lanes,
+ &tc358746->dphy_cfg);
+ if (err)
+ goto err_vep;
+
+ tc358746->mbusfmt = tc358746_def_fmt;
+ tc358746->vb_size = TC358746_VB_DEFAULT_SIZE;
+
+ dev_set_drvdata(dev, tc358746);
+ pm_runtime_set_autosuspend_delay(dev, 200);
+ pm_runtime_use_autosuspend(dev);
+ pm_runtime_enable(dev);
+
+ err = pm_runtime_resume_and_get(dev);
+ if (err < 0) {
+ dev_err(dev, "Failed to resume the device\n");
+ goto err_vep;
+ }
+
+ /* Ensure that CSI interface is put into LP-11 state */
+ err = tc358746_sw_reset(tc358746);
+ if (err) {
+ pm_runtime_put_noidle(dev);
+ dev_err(dev, "Failed to reset the device\n");
+ goto err_pm;
+ }
+
+ err = tc358746_read(tc358746, CHIPID_REG, &val);
+ pm_runtime_mark_last_busy(dev);
+ pm_runtime_put_sync_autosuspend(dev);
+ if (err) {
+ dev_err(dev, "Failed to read chipid\n");
+ err = -ENODEV;
+ goto err_pm;
+ }
+
+ if (FIELD_GET(CHIPID, val) != 0x44) {
+ dev_err(dev, "Invalid chipid 0x%02x\n",
+ (u32)FIELD_GET(CHIPID, val));
+ err = -ENODEV;
+ goto err_pm;
+ }
+
+ /* Optional MCLK provider support */
+ if (device_property_present(dev, "#clock-cells")) {
+ const char *mclk_name;
+
+ /* Init to highest possibel MCLK */
+ tc358746->mclk_postdiv = 512;
+ tc358746->mclk_prediv = 8;
+
+ mclk_name = "tc358746-mclk";
+ device_property_read_string(dev, "clock-output-names",
+ &mclk_name);
+
+ mclk_initdata.name = mclk_name;
+ mclk_initdata.ops = &tc358746_mclk_ops;
+ tc358746->mclk_hw.init = &mclk_initdata;
+
+ err = devm_clk_hw_register(dev, &tc358746->mclk_hw);
+ if (err) {
+ dev_err(dev, "Failed to register mclk provider\n");
+ goto err_pm;
+ }
+
+ err = devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get,
+ &tc358746->mclk_hw);
+ if (err) {
+ dev_err(dev, "Failed to add mclk provider\n");
+ goto err_pm;
+ }
+ }
+
+ v4l2_ctrl_handler_init(&tc358746->ctrl_hdl, 1);
+
+ ctrl = v4l2_ctrl_new_int_menu(&tc358746->ctrl_hdl, NULL,
+ V4L2_CID_LINK_FREQ, 0, 0,
+ vep->link_frequencies);
+ if (ctrl)
+ ctrl->flags |= V4L2_CTRL_FLAG_READ_ONLY;
+
+ tc358746->sd.ctrl_handler = &tc358746->ctrl_hdl;
+ if (tc358746->ctrl_hdl.error) {
+ err = tc358746->ctrl_hdl.error;
+ goto err_pm;
+ }
+
+ v4l2_ctrl_handler_setup(&tc358746->ctrl_hdl);
+
+ err = tc358746_async_register(tc358746);
+ if (err < 0)
+ goto err_ctrl;
+
+ dev_info(dev, "%s found @ 0x%x (%s)\n", client->name,
+ client->addr, client->adapter->name);
+
+ return 0;
+
+err_ctrl:
+ v4l2_ctrl_handler_free(&tc358746->ctrl_hdl);
+err_pm:
+ pm_runtime_disable(dev);
+ pm_runtime_set_suspended(dev);
+ pm_runtime_dont_use_autosuspend(dev);
+err_vep:
+ v4l2_fwnode_endpoint_free(vep);
+err_mc:
+ media_entity_cleanup(&sd->entity);
+
+ return err;
+}
+
+static int tc358746_remove(struct i2c_client *client)
+{
+ struct v4l2_subdev *sd = i2c_get_clientdata(client);
+ struct tc358746 *tc358746 = to_tc358746(sd);
+
+ v4l2_ctrl_handler_free(&tc358746->ctrl_hdl);
+ v4l2_fwnode_endpoint_free(&tc358746->csi_vep);
+ v4l2_async_nf_unregister(&tc358746->notifier);
+ v4l2_async_nf_cleanup(&tc358746->notifier);
+ v4l2_async_unregister_subdev(sd);
+ v4l2_device_unregister_subdev(sd);
+ media_entity_cleanup(&sd->entity);
+
+ pm_runtime_disable(sd->dev);
+ pm_runtime_set_suspended(sd->dev);
+ pm_runtime_dont_use_autosuspend(sd->dev);
+
+ return 0;
+}
+
+static int tc358746_suspend(struct device *dev)
+{
+ struct tc358746 *tc358746 = dev_get_drvdata(dev);
+
+ clk_disable_unprepare(tc358746->refclk);
+
+ return regulator_bulk_disable(ARRAY_SIZE(tc358746_supplies),
+ tc358746->supplies);
+}
+
+static int tc358746_resume(struct device *dev)
+{
+ struct tc358746 *tc358746 = dev_get_drvdata(dev);
+ int err;
+
+ gpiod_set_value(tc358746->reset_gpio, 1);
+
+ err = regulator_bulk_enable(ARRAY_SIZE(tc358746_supplies),
+ tc358746->supplies);
+ if (err)
+ return err;
+
+ /* min. 200ns */
+ usleep_range(10, 20);
+
+ gpiod_set_value(tc358746->reset_gpio, 0);
+
+ err = clk_prepare_enable(tc358746->refclk);
+ if (err)
+ return err;
+
+ /* min. 700us ... 1ms */
+ usleep_range(1000, 1500);
+
+ /* Sync state */
+ err = tc358746_apply_pll_config(tc358746);
+ if (err)
+ return err;
+
+ err = tc358746_apply_dphy_config(tc358746);
+ if (err)
+ return err;
+
+ return tc358746_apply_misc_config(tc358746);
+}
+
+DEFINE_RUNTIME_DEV_PM_OPS(tc358746_pm_ops, tc358746_suspend,
+ tc358746_resume, NULL);
+
+static const struct of_device_id __maybe_unused tc358746_of_match[] = {
+ { .compatible = "toshiba,tc358746" },
+ { },
+};
+MODULE_DEVICE_TABLE(of, tc358746_of_match);
+
+static struct i2c_driver tc358746_driver = {
+ .driver = {
+ .name = "tc358746",
+ .pm = pm_ptr(&tc358746_pm_ops),
+ .of_match_table = tc358746_of_match,
+ },
+ .probe_new = tc358746_probe,
+ .remove = tc358746_remove,
+};
+
+module_i2c_driver(tc358746_driver);
+
+MODULE_DESCRIPTION("Toshiba TC358746 Parallel to CSI-2 bridge driver");
+MODULE_AUTHOR("Marco Felsch <kernel@pengutronix.de>");
+MODULE_LICENSE("GPL");
--
2.30.2
--
linux-phy mailing list
linux-phy@lists.infradead.org
https://lists.infradead.org/mailman/listinfo/linux-phy
^ permalink raw reply related [flat|nested] 34+ messages in thread
* Re: [PATCH 3/4] media: dt-bindings: add bindings for Toshiba TC358746
2022-08-18 14:33 ` Marco Felsch
@ 2022-08-22 18:11 ` Rob Herring
-1 siblings, 0 replies; 34+ messages in thread
From: Rob Herring @ 2022-08-22 18:11 UTC (permalink / raw)
To: Marco Felsch
Cc: kishon, linux-kernel, mchehab, vkoul, laurent.pinchart+renesas,
robh+dt, hverkuil, jacopo, linux-media, kernel,
krzysztof.kozlowski+dt, devicetree, linux-phy, sakari.ailus
On Thu, 18 Aug 2022 16:33:06 +0200, Marco Felsch wrote:
> Add the bindings for the Toshiba TC358746 Parallel <-> MIPI-CSI bridge
> driver.
>
> Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
> ---
> .../bindings/media/i2c/toshiba,tc358746.yaml | 157 ++++++++++++++++++
> 1 file changed, 157 insertions(+)
> create mode 100644 Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
>
Reviewed-by: Rob Herring <robh@kernel.org>
^ permalink raw reply [flat|nested] 34+ messages in thread
* Re: [PATCH 3/4] media: dt-bindings: add bindings for Toshiba TC358746
@ 2022-08-22 18:11 ` Rob Herring
0 siblings, 0 replies; 34+ messages in thread
From: Rob Herring @ 2022-08-22 18:11 UTC (permalink / raw)
To: Marco Felsch
Cc: kishon, linux-kernel, mchehab, vkoul, laurent.pinchart+renesas,
robh+dt, hverkuil, jacopo, linux-media, kernel,
krzysztof.kozlowski+dt, devicetree, linux-phy, sakari.ailus
On Thu, 18 Aug 2022 16:33:06 +0200, Marco Felsch wrote:
> Add the bindings for the Toshiba TC358746 Parallel <-> MIPI-CSI bridge
> driver.
>
> Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
> ---
> .../bindings/media/i2c/toshiba,tc358746.yaml | 157 ++++++++++++++++++
> 1 file changed, 157 insertions(+)
> create mode 100644 Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
>
Reviewed-by: Rob Herring <robh@kernel.org>
--
linux-phy mailing list
linux-phy@lists.infradead.org
https://lists.infradead.org/mailman/listinfo/linux-phy
^ permalink raw reply [flat|nested] 34+ messages in thread
* Re: [PATCH 0/4] Add support for Toshiba TC358746
2022-08-18 14:33 ` Marco Felsch
@ 2022-08-31 8:14 ` Marco Felsch
-1 siblings, 0 replies; 34+ messages in thread
From: Marco Felsch @ 2022-08-31 8:14 UTC (permalink / raw)
To: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, laurent.pinchart+renesas
Cc: linux-phy, devicetree, linux-kernel, kernel, linux-media
Hi,
gentle ping on this series.
On 22-08-18, Marco Felsch wrote:
> Hi,
>
> this small series adds the support for the Toshiba TC358746 MIPI-CSI to
> Parallel converter chip. After a long period I finally had the time to
> include Sakaris points made on my v2 [1]. Since [1] is long time ago
> and I reworked the driver a lot, I don't add a v3 on this series. Also
> all already provided RB tags are dropped.
>
> Regards,
> Marco
>
> [1] https://www.mail-archive.com/linux-media@vger.kernel.org/msg147901.html
>
> Marco Felsch (4):
> phy: dphy: refactor get_default_config
> phy: dphy: add support to calculate the timing based on hs_clk_rate
> media: dt-bindings: add bindings for Toshiba TC358746
> media: tc358746: add Toshiba TC358746 Parallel to CSI-2 bridge driver
>
> .../bindings/media/i2c/toshiba,tc358746.yaml | 157 ++
> drivers/media/i2c/Kconfig | 17 +
> drivers/media/i2c/Makefile | 1 +
> drivers/media/i2c/tc358746.c | 1645 +++++++++++++++++
> drivers/phy/phy-core-mipi-dphy.c | 31 +-
> include/linux/phy/phy-mipi-dphy.h | 3 +
> 6 files changed, 1850 insertions(+), 4 deletions(-)
> create mode 100644 Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
> create mode 100644 drivers/media/i2c/tc358746.c
>
> --
> 2.30.2
>
>
>
^ permalink raw reply [flat|nested] 34+ messages in thread
* Re: [PATCH 0/4] Add support for Toshiba TC358746
@ 2022-08-31 8:14 ` Marco Felsch
0 siblings, 0 replies; 34+ messages in thread
From: Marco Felsch @ 2022-08-31 8:14 UTC (permalink / raw)
To: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, laurent.pinchart+renesas
Cc: linux-phy, devicetree, linux-kernel, kernel, linux-media
Hi,
gentle ping on this series.
On 22-08-18, Marco Felsch wrote:
> Hi,
>
> this small series adds the support for the Toshiba TC358746 MIPI-CSI to
> Parallel converter chip. After a long period I finally had the time to
> include Sakaris points made on my v2 [1]. Since [1] is long time ago
> and I reworked the driver a lot, I don't add a v3 on this series. Also
> all already provided RB tags are dropped.
>
> Regards,
> Marco
>
> [1] https://www.mail-archive.com/linux-media@vger.kernel.org/msg147901.html
>
> Marco Felsch (4):
> phy: dphy: refactor get_default_config
> phy: dphy: add support to calculate the timing based on hs_clk_rate
> media: dt-bindings: add bindings for Toshiba TC358746
> media: tc358746: add Toshiba TC358746 Parallel to CSI-2 bridge driver
>
> .../bindings/media/i2c/toshiba,tc358746.yaml | 157 ++
> drivers/media/i2c/Kconfig | 17 +
> drivers/media/i2c/Makefile | 1 +
> drivers/media/i2c/tc358746.c | 1645 +++++++++++++++++
> drivers/phy/phy-core-mipi-dphy.c | 31 +-
> include/linux/phy/phy-mipi-dphy.h | 3 +
> 6 files changed, 1850 insertions(+), 4 deletions(-)
> create mode 100644 Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
> create mode 100644 drivers/media/i2c/tc358746.c
>
> --
> 2.30.2
>
>
>
--
linux-phy mailing list
linux-phy@lists.infradead.org
https://lists.infradead.org/mailman/listinfo/linux-phy
^ permalink raw reply [flat|nested] 34+ messages in thread
* Re: [PATCH 1/4] phy: dphy: refactor get_default_config
2022-08-18 14:33 ` Marco Felsch
@ 2022-09-02 17:45 ` Vinod Koul
-1 siblings, 0 replies; 34+ messages in thread
From: Vinod Koul @ 2022-09-02 17:45 UTC (permalink / raw)
To: Marco Felsch
Cc: mchehab, robh+dt, krzysztof.kozlowski+dt, kishon, sakari.ailus,
hverkuil, jacopo, laurent.pinchart+renesas, linux-kernel,
linux-phy, devicetree, linux-media, kernel
On 18-08-22, 16:33, Marco Felsch wrote:
> Factor out the calculation into phy_mipi_dphy_calc_config(). This is
> needed for the follow up patch which adds the support to calculate the
> timings based on a given hs clock. No functional changes are done.
Acked-By: Vinod Koul <vkoul@kernel.org>
--
~Vinod
^ permalink raw reply [flat|nested] 34+ messages in thread
* Re: [PATCH 1/4] phy: dphy: refactor get_default_config
@ 2022-09-02 17:45 ` Vinod Koul
0 siblings, 0 replies; 34+ messages in thread
From: Vinod Koul @ 2022-09-02 17:45 UTC (permalink / raw)
To: Marco Felsch
Cc: mchehab, robh+dt, krzysztof.kozlowski+dt, kishon, sakari.ailus,
hverkuil, jacopo, laurent.pinchart+renesas, linux-kernel,
linux-phy, devicetree, linux-media, kernel
On 18-08-22, 16:33, Marco Felsch wrote:
> Factor out the calculation into phy_mipi_dphy_calc_config(). This is
> needed for the follow up patch which adds the support to calculate the
> timings based on a given hs clock. No functional changes are done.
Acked-By: Vinod Koul <vkoul@kernel.org>
--
~Vinod
--
linux-phy mailing list
linux-phy@lists.infradead.org
https://lists.infradead.org/mailman/listinfo/linux-phy
^ permalink raw reply [flat|nested] 34+ messages in thread
* Re: [PATCH 2/4] phy: dphy: add support to calculate the timing based on hs_clk_rate
2022-08-18 14:33 ` Marco Felsch
@ 2022-09-02 17:45 ` Vinod Koul
-1 siblings, 0 replies; 34+ messages in thread
From: Vinod Koul @ 2022-09-02 17:45 UTC (permalink / raw)
To: Marco Felsch
Cc: mchehab, robh+dt, krzysztof.kozlowski+dt, kishon, sakari.ailus,
hverkuil, jacopo, laurent.pinchart+renesas, linux-kernel,
linux-phy, devicetree, linux-media, kernel
On 18-08-22, 16:33, Marco Felsch wrote:
> For MIPI-CSI sender use-case it is common to specify the allowed
> link-frequencies which should be used for the MIPI link and is
> half the hs-clock rate.
>
> This commit adds a helper to calculate the D-PHY timing based on the
> hs-clock rate so we don't need to calculate the timings within the
> driver.
Acked-By: Vinod Koul <vkoul@kernel.org>
--
~Vinod
^ permalink raw reply [flat|nested] 34+ messages in thread
* Re: [PATCH 2/4] phy: dphy: add support to calculate the timing based on hs_clk_rate
@ 2022-09-02 17:45 ` Vinod Koul
0 siblings, 0 replies; 34+ messages in thread
From: Vinod Koul @ 2022-09-02 17:45 UTC (permalink / raw)
To: Marco Felsch
Cc: mchehab, robh+dt, krzysztof.kozlowski+dt, kishon, sakari.ailus,
hverkuil, jacopo, laurent.pinchart+renesas, linux-kernel,
linux-phy, devicetree, linux-media, kernel
On 18-08-22, 16:33, Marco Felsch wrote:
> For MIPI-CSI sender use-case it is common to specify the allowed
> link-frequencies which should be used for the MIPI link and is
> half the hs-clock rate.
>
> This commit adds a helper to calculate the D-PHY timing based on the
> hs-clock rate so we don't need to calculate the timings within the
> driver.
Acked-By: Vinod Koul <vkoul@kernel.org>
--
~Vinod
--
linux-phy mailing list
linux-phy@lists.infradead.org
https://lists.infradead.org/mailman/listinfo/linux-phy
^ permalink raw reply [flat|nested] 34+ messages in thread
* Re: [PATCH 3/4] media: dt-bindings: add bindings for Toshiba TC358746
2022-08-18 14:33 ` Marco Felsch
@ 2022-09-04 22:35 ` Laurent Pinchart
-1 siblings, 0 replies; 34+ messages in thread
From: Laurent Pinchart @ 2022-09-04 22:35 UTC (permalink / raw)
To: Marco Felsch
Cc: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, linux-kernel, linux-phy,
devicetree, linux-media, kernel
Hi Marco,
Thank you for the patch.
On Thu, Aug 18, 2022 at 04:33:06PM +0200, Marco Felsch wrote:
> Add the bindings for the Toshiba TC358746 Parallel <-> MIPI-CSI bridge
> driver.
>
> Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
> ---
> .../bindings/media/i2c/toshiba,tc358746.yaml | 157 ++++++++++++++++++
> 1 file changed, 157 insertions(+)
> create mode 100644 Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
>
> diff --git a/Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml b/Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
> new file mode 100644
> index 000000000000..9783cca363c6
> --- /dev/null
> +++ b/Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
> @@ -0,0 +1,157 @@
> +# SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause)
> +%YAML 1.2
> +---
> +$id: http://devicetree.org/schemas/media/i2c/toshiba,tc358746.yaml#
> +$schema: http://devicetree.org/meta-schemas/core.yaml#
> +
> +title: Toshiba TC358746 Parallel to MIPI CSI2 Bridge
> +
> +maintainers:
> + - Marco Felsch <kernel@pengutronix.de>
> +
> +description: |-
> + The Toshiba TC358746 converts a parallel video stream into a MIPI CSI-2
> + stream. The direction can be either parallel-in -> csi-out or csi-in ->
> + parallel-out The chip is programmable trough I2C and SPI but the SPI
> + interface is only supported in parallel-in -> csi-out mode.
> +
> + Note that the current device tree bindings only support the
> + parallel-in -> csi-out path.
> +
> +properties:
> + compatible:
> + const: toshiba,tc358746
> +
> + reg:
> + maxItems: 1
> +
> + clocks:
> + description:
> + The phandle to the reference clock source. This corresponds to the
> + hardware pin REFCLK.
> + maxItems: 1
> +
> + clock-names:
> + const: refclk
As there's a single clock, should we omit the clock name ?
> +
> +# The bridge can act as clock provider for the sensor. To enable this support
> +# #clock-cells must be specified. Attention if this feature is used than the
s/than/then/
> +# mclk rate must be at least: (2 * link-frequency) / 8
> +# `------------------´ ^
> +# internal PLL rate smallest possible mclk-div
Could this be captured in the description of the property instead of a
comment ?
> + "#clock-cells":
> + const: 0
> +
> + clock-output-names:
> + description:
> + The clock name of the MCLK output, the default name is tc358746-mclk.
> + maxItems: 1
> +
> + vddc-supply:
> + description: Digital core voltage supply, 1.2 volts
> +
> + vddio-supply:
> + description: Digital I/O voltage supply, 1.8 volts
> +
> + vddmipi-supply:
> + description: MIPI CSI phy voltage supply, 1.2 volts
> +
> + reset-gpios:
> + description:
> + The phandle and specifier for the GPIO that controls the chip reset.
> + This corresponds to the hardware pin RESX which is physically active low.
> + maxItems: 1
> +
> + ports:
> + $ref: /schemas/graph.yaml#/properties/ports
> + properties:
> + port@0:
> + $ref: /schemas/graph.yaml#/properties/port
> + description: Input port
Are the H/V sync signal polarities fixed, or should they be specified
here ? Does the chip support external sync only, or also BT.656 ? In the
latter case this needs a bus-type.
> +
> + port@1:
> + $ref: /schemas/graph.yaml#/$defs/port-base
> + description: Output port
> +
> + properties:
> + endpoint:
> + $ref: /schemas/media/video-interfaces.yaml#
> + unevaluatedProperties: false
> +
> + properties:
> + data-lanes:
> + minItems: 1
> + maxItems: 4
> +
> + clock-noncontinuous: true
> + link-frequencies: true
> +
> + required:
> + - data-lanes
> + - link-frequencies
> +
> + required:
> + - port@0
> + - port@1
> +
> +required:
> + - compatible
> + - reg
> + - clocks
> + - clock-names
> + - vddc-supply
> + - vddio-supply
> + - vddmipi-supply
> + - ports
> +
> +additionalProperties: false
> +
> +examples:
> + - |
> + #include <dt-bindings/gpio/gpio.h>
> +
> + i2c {
> + #address-cells = <1>;
> + #size-cells = <0>;
> +
> + csi-bridge@e {
> + compatible = "toshiba,tc358746";
> + reg = <0xe>;
> +
> + clocks = <&refclk>;
> + clock-names = "refclk";
> +
> + reset-gpios = <&gpio 2 GPIO_ACTIVE_LOW>;
> +
> + vddc-supply = <&v1_2d>;
> + vddio-supply = <&v1_8d>;
> + vddmipi-supply = <&v1_2d>;
> +
> + /* sensor mclk provider */
> + #clock-cells = <0>;
> +
> + ports {
> + #address-cells = <1>;
> + #size-cells = <0>;
> +
> + /* Input */
> + port@0 {
> + reg = <0>;
> + tc358746_in: endpoint {
> + remote-endpoint = <&sensor_out>;
> + };
Wrong indentation here.
> + };
> +
> + /* Output */
> + port@1 {
> + reg = <1>;
> + tc358746_out: endpoint {
> + remote-endpoint = <&mipi_csi2_in>;
> + data-lanes = <1 2>;
> + clock-noncontinuous;
> + link-frequencies = /bits/ 64 <216000000>;
> + };
> + };
> + };
> + };
> + };
--
Regards,
Laurent Pinchart
^ permalink raw reply [flat|nested] 34+ messages in thread
* Re: [PATCH 3/4] media: dt-bindings: add bindings for Toshiba TC358746
@ 2022-09-04 22:35 ` Laurent Pinchart
0 siblings, 0 replies; 34+ messages in thread
From: Laurent Pinchart @ 2022-09-04 22:35 UTC (permalink / raw)
To: Marco Felsch
Cc: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, linux-kernel, linux-phy,
devicetree, linux-media, kernel
Hi Marco,
Thank you for the patch.
On Thu, Aug 18, 2022 at 04:33:06PM +0200, Marco Felsch wrote:
> Add the bindings for the Toshiba TC358746 Parallel <-> MIPI-CSI bridge
> driver.
>
> Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
> ---
> .../bindings/media/i2c/toshiba,tc358746.yaml | 157 ++++++++++++++++++
> 1 file changed, 157 insertions(+)
> create mode 100644 Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
>
> diff --git a/Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml b/Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
> new file mode 100644
> index 000000000000..9783cca363c6
> --- /dev/null
> +++ b/Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
> @@ -0,0 +1,157 @@
> +# SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause)
> +%YAML 1.2
> +---
> +$id: http://devicetree.org/schemas/media/i2c/toshiba,tc358746.yaml#
> +$schema: http://devicetree.org/meta-schemas/core.yaml#
> +
> +title: Toshiba TC358746 Parallel to MIPI CSI2 Bridge
> +
> +maintainers:
> + - Marco Felsch <kernel@pengutronix.de>
> +
> +description: |-
> + The Toshiba TC358746 converts a parallel video stream into a MIPI CSI-2
> + stream. The direction can be either parallel-in -> csi-out or csi-in ->
> + parallel-out The chip is programmable trough I2C and SPI but the SPI
> + interface is only supported in parallel-in -> csi-out mode.
> +
> + Note that the current device tree bindings only support the
> + parallel-in -> csi-out path.
> +
> +properties:
> + compatible:
> + const: toshiba,tc358746
> +
> + reg:
> + maxItems: 1
> +
> + clocks:
> + description:
> + The phandle to the reference clock source. This corresponds to the
> + hardware pin REFCLK.
> + maxItems: 1
> +
> + clock-names:
> + const: refclk
As there's a single clock, should we omit the clock name ?
> +
> +# The bridge can act as clock provider for the sensor. To enable this support
> +# #clock-cells must be specified. Attention if this feature is used than the
s/than/then/
> +# mclk rate must be at least: (2 * link-frequency) / 8
> +# `------------------´ ^
> +# internal PLL rate smallest possible mclk-div
Could this be captured in the description of the property instead of a
comment ?
> + "#clock-cells":
> + const: 0
> +
> + clock-output-names:
> + description:
> + The clock name of the MCLK output, the default name is tc358746-mclk.
> + maxItems: 1
> +
> + vddc-supply:
> + description: Digital core voltage supply, 1.2 volts
> +
> + vddio-supply:
> + description: Digital I/O voltage supply, 1.8 volts
> +
> + vddmipi-supply:
> + description: MIPI CSI phy voltage supply, 1.2 volts
> +
> + reset-gpios:
> + description:
> + The phandle and specifier for the GPIO that controls the chip reset.
> + This corresponds to the hardware pin RESX which is physically active low.
> + maxItems: 1
> +
> + ports:
> + $ref: /schemas/graph.yaml#/properties/ports
> + properties:
> + port@0:
> + $ref: /schemas/graph.yaml#/properties/port
> + description: Input port
Are the H/V sync signal polarities fixed, or should they be specified
here ? Does the chip support external sync only, or also BT.656 ? In the
latter case this needs a bus-type.
> +
> + port@1:
> + $ref: /schemas/graph.yaml#/$defs/port-base
> + description: Output port
> +
> + properties:
> + endpoint:
> + $ref: /schemas/media/video-interfaces.yaml#
> + unevaluatedProperties: false
> +
> + properties:
> + data-lanes:
> + minItems: 1
> + maxItems: 4
> +
> + clock-noncontinuous: true
> + link-frequencies: true
> +
> + required:
> + - data-lanes
> + - link-frequencies
> +
> + required:
> + - port@0
> + - port@1
> +
> +required:
> + - compatible
> + - reg
> + - clocks
> + - clock-names
> + - vddc-supply
> + - vddio-supply
> + - vddmipi-supply
> + - ports
> +
> +additionalProperties: false
> +
> +examples:
> + - |
> + #include <dt-bindings/gpio/gpio.h>
> +
> + i2c {
> + #address-cells = <1>;
> + #size-cells = <0>;
> +
> + csi-bridge@e {
> + compatible = "toshiba,tc358746";
> + reg = <0xe>;
> +
> + clocks = <&refclk>;
> + clock-names = "refclk";
> +
> + reset-gpios = <&gpio 2 GPIO_ACTIVE_LOW>;
> +
> + vddc-supply = <&v1_2d>;
> + vddio-supply = <&v1_8d>;
> + vddmipi-supply = <&v1_2d>;
> +
> + /* sensor mclk provider */
> + #clock-cells = <0>;
> +
> + ports {
> + #address-cells = <1>;
> + #size-cells = <0>;
> +
> + /* Input */
> + port@0 {
> + reg = <0>;
> + tc358746_in: endpoint {
> + remote-endpoint = <&sensor_out>;
> + };
Wrong indentation here.
> + };
> +
> + /* Output */
> + port@1 {
> + reg = <1>;
> + tc358746_out: endpoint {
> + remote-endpoint = <&mipi_csi2_in>;
> + data-lanes = <1 2>;
> + clock-noncontinuous;
> + link-frequencies = /bits/ 64 <216000000>;
> + };
> + };
> + };
> + };
> + };
--
Regards,
Laurent Pinchart
--
linux-phy mailing list
linux-phy@lists.infradead.org
https://lists.infradead.org/mailman/listinfo/linux-phy
^ permalink raw reply [flat|nested] 34+ messages in thread
* Re: [PATCH 4/4] media: tc358746: add Toshiba TC358746 Parallel to CSI-2 bridge driver
2022-08-18 14:33 ` Marco Felsch
@ 2022-09-05 20:03 ` Laurent Pinchart
-1 siblings, 0 replies; 34+ messages in thread
From: Laurent Pinchart @ 2022-09-05 20:03 UTC (permalink / raw)
To: Marco Felsch
Cc: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, linux-kernel, linux-phy,
devicetree, linux-media, kernel
Hi Marco,
Thank you for the patch.
On Thu, Aug 18, 2022 at 04:33:07PM +0200, Marco Felsch wrote:
> Adding support for the TC358746 parallel <-> MIPI CSI bridge. This chip
> supports two operating modes:
> 1st) parallel-in -> mipi-csi out
> 2nd) mipi-csi in -> parallel out
>
> This patch only adds the support for the 1st mode.
>
> Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
> ---
> drivers/media/i2c/Kconfig | 17 +
> drivers/media/i2c/Makefile | 1 +
> drivers/media/i2c/tc358746.c | 1645 ++++++++++++++++++++++++++++++++++
> 3 files changed, 1663 insertions(+)
> create mode 100644 drivers/media/i2c/tc358746.c
>
> diff --git a/drivers/media/i2c/Kconfig b/drivers/media/i2c/Kconfig
> index 7806d4b81716..aefb9c9e0c08 100644
> --- a/drivers/media/i2c/Kconfig
> +++ b/drivers/media/i2c/Kconfig
> @@ -1272,6 +1272,23 @@ config VIDEO_TC358743_CEC
> When selected the tc358743 will support the optional
> HDMI CEC feature.
>
> +config VIDEO_TC358746
> + tristate "Toshiba TC358746 parallel-CSI2 bridge"
> + depends on VIDEO_DEV && I2C
> + select VIDEO_V4L2_SUBDEV_API
> + select MEDIA_CONTROLLER
> + select V4L2_FWNODE
> + select GENERIC_PHY_MIPI_DPHY
> + select REGMAP_I2C
> + select COMMON_CLK
> + help
> + Support for the Toshiba TC358746 parallel to MIPI CSI-2 bridge.
> + The bridge can work in both directions but currently only the
> + parallel-in / csi-out path is supported.
> +
> + To compile this driver as a module, choose M here: the
> + module will be called tc358746.
> +
> config VIDEO_TVP514X
> tristate "Texas Instruments TVP514x video decoder"
> depends on VIDEO_DEV && I2C
> diff --git a/drivers/media/i2c/Makefile b/drivers/media/i2c/Makefile
> index 0a2933103dd9..d1096c2ab480 100644
> --- a/drivers/media/i2c/Makefile
> +++ b/drivers/media/i2c/Makefile
> @@ -118,6 +118,7 @@ obj-$(CONFIG_VIDEO_SONY_BTF_MPX) += sony-btf-mpx.o
> obj-$(CONFIG_VIDEO_SR030PC30) += sr030pc30.o
> obj-$(CONFIG_VIDEO_ST_MIPID02) += st-mipid02.o
> obj-$(CONFIG_VIDEO_TC358743) += tc358743.o
> +obj-$(CONFIG_VIDEO_TC358746) += tc358746.o
> obj-$(CONFIG_VIDEO_TDA1997X) += tda1997x.o
> obj-$(CONFIG_VIDEO_TDA7432) += tda7432.o
> obj-$(CONFIG_VIDEO_TDA9840) += tda9840.o
> diff --git a/drivers/media/i2c/tc358746.c b/drivers/media/i2c/tc358746.c
> new file mode 100644
> index 000000000000..7b71d0cf72a9
> --- /dev/null
> +++ b/drivers/media/i2c/tc358746.c
> @@ -0,0 +1,1645 @@
> +// SPDX-License-Identifier: GPL-2.0-only
> +/*
> + * TC358746 - Parallel <-> CSI-2 Bridge
> + *
> + * Copyright 2022 Marco Felsch <kernel@pengutronix.de>
> + *
> + * Notes:
> + * - Currently only 'Parallel-in -> CSI-out' mode is supported!
> + */
> +
> +#include <linux/bitfield.h>
> +#include <linux/clk.h>
> +#include <linux/clk-provider.h>
> +#include <linux/delay.h>
> +#include <linux/i2c.h>
> +#include <linux/interrupt.h>
> +#include <linux/kernel.h>
> +#include <linux/module.h>
> +#include <linux/phy/phy-mipi-dphy.h>
> +#include <linux/property.h>
> +#include <linux/pm_runtime.h>
> +#include <linux/regmap.h>
> +#include <media/v4l2-ctrls.h>
> +#include <media/v4l2-device.h>
> +#include <media/v4l2-fwnode.h>
> +#include <media/v4l2-mc.h>
> +
> +/* 16-bit registers */
> +#define CHIPID_REG 0x0000
> +#define CHIPID GENMASK(15, 8)
> +
> +#define SYSCTL_REG 0x0002
> +#define SRESET BIT(0)
> +
> +#define CONFCTL_REG 0x0004
> +#define PDATAF_MASK GENMASK(9, 8)
> +#define PDATAF_MODE0 0
> +#define PDATAF_MODE1 1
> +#define PDATAF_MODE2 2
> +#define PDATAF(val) FIELD_PREP(PDATAF_MASK, (val))
> +#define PPEN BIT(6)
> +#define DATALANE_MASK GENMASK(1, 0)
> +
> +#define FIFOCTL_REG 0x0006
> +#define DATAFMT_REG 0x0008
> +#define PDFMT(val) FIELD_PREP(GENMASK(7, 4), (val))
> +
> +#define MCLKCTL_REG 0x000c
> +#define MCLK_HIGH_MASK GENMASK(15, 8)
> +#define MCLK_LOW_MASK GENMASK(7, 0)
> +#define MCLK_HIGH(val) FIELD_PREP(MCLK_HIGH_MASK, (val))
> +#define MCLK_LOW(val) FIELD_PREP(MCLK_LOW_MASK, (val))
> +
> +#define PLLCTL0_REG 0x0016
> +#define PLL_PRD_MASK GENMASK(15, 12)
> +#define PLL_PRD(val) FIELD_PREP(PLL_PRD_MASK, (val))
> +#define PLL_FBD_MASK GENMASK(8, 0)
> +#define PLL_FBD(val) FIELD_PREP(PLL_FBD_MASK, (val))
> +
> +#define PLLCTL1_REG 0x0018
> +#define PLL_FRS_MASK GENMASK(11, 10)
> +#define PLL_FRS(val) FIELD_PREP(PLL_FRS_MASK, (val))
> +#define CKEN BIT(4)
> +#define RESETB BIT(1)
> +#define PLL_EN BIT(0)
> +
> +#define CLKCTL_REG 0x0020
> +#define MCLKDIV_MASK GENMASK(3, 2)
> +#define MCLKDIV(val) FIELD_PREP(MCLKDIV_MASK, (val))
> +#define MCLKDIV_8 0
> +#define MCLKDIV_4 1
> +#define MCLKDIV_2 2
> +
> +#define WORDCNT_REG 0x0022
> +#define PP_MISC_REG 0x0032
> +#define FRMSTOP BIT(15)
> +#define RSTPTR BIT(14)
> +
> +/* 32-bit registers */
> +#define CLW_DPHYCONTTX_REG 0x0100
> +#define CLW_CNTRL_REG 0x0140
> +#define D0W_CNTRL_REG 0x0144
> +#define LANEDISABLE BIT(0)
> +
> +#define STARTCNTRL_REG 0x0204
> +#define START BIT(0)
> +
> +#define LINEINITCNT_REG 0x0210
> +#define LPTXTIMECNT_REG 0x0214
> +#define TCLK_HEADERCNT_REG 0x0218
> +#define TCLK_ZEROCNT(val) FIELD_PREP(GENMASK(15, 8), (val))
> +#define TCLK_PREPARECNT(val) FIELD_PREP(GENMASK(6, 0), (val))
> +
> +#define TCLK_TRAILCNT_REG 0x021C
> +#define THS_HEADERCNT_REG 0x0220
> +#define THS_ZEROCNT(val) FIELD_PREP(GENMASK(14, 8), (val))
> +#define THS_PREPARECNT(val) FIELD_PREP(GENMASK(6, 0), (val))
> +
> +#define TWAKEUP_REG 0x0224
> +#define TCLK_POSTCNT_REG 0x0228
> +#define THS_TRAILCNT_REG 0x022C
> +#define HSTXVREGEN_REG 0x0234
> +#define TXOPTIONCNTRL_REG 0x0238
> +#define CSI_CONTROL_REG 0x040C
> +#define CSI_MODE BIT(15)
> +#define TXHSMD BIT(7)
> +#define NOL(val) FIELD_PREP(GENMASK(2, 1), (val))
> +
> +#define CSI_CONFW_REG 0x0500
> +#define MODE(val) FIELD_PREP(GENMASK(31, 29), (val))
> +#define MODE_SET 0x5
> +#define ADDRESS(val) FIELD_PREP(GENMASK(28, 24), (val))
> +#define CSI_CONTROL_ADDRESS 0x3
> +#define DATA(val) FIELD_PREP(GENMASK(15, 0), (val))
> +
> +#define CSI_START_REG 0x0518
> +#define STRT BIT(0)
> +
> +static const struct v4l2_mbus_framefmt tc358746_def_fmt = {
> + .width = 640,
> + .height = 480,
> + .code = MEDIA_BUS_FMT_UYVY8_2X8,
> + .field = V4L2_FIELD_NONE,
> + .colorspace = V4L2_COLORSPACE_DEFAULT,
> + .ycbcr_enc = V4L2_YCBCR_ENC_DEFAULT,
> + .quantization = V4L2_QUANTIZATION_DEFAULT,
> + .xfer_func = V4L2_XFER_FUNC_DEFAULT,
> +};
> +
> +static const char * const tc358746_supplies[] = {
> + "vddc", "vddio", "vddmipi"
> +};
> +
> +enum {
> + TC358746_SINK,
> + TC358746_SOURCE,
> + TC358746_NR_PADS
> +};
> +
> +struct tc358746 {
> + struct v4l2_subdev sd;
> + struct media_pad pads[TC358746_NR_PADS];
> + struct v4l2_async_notifier notifier;
> + struct v4l2_mbus_framefmt mbusfmt;
Could you use the active state API instead of manually storing mbusfmt
here ? It involves
- Implementing the .init_cfg() operation
- Calling v4l2_subdev_init_finalize() in probe
- Replacing calls to __tc358746_get_pad_format() with
v4l2_subdev_get_pad_format()
- Propagating the format from sink to source in tc358746_set_fmt()
- Dropping tc358746_src_mbus_code() from tc358746_get_fmt() and simply
retrieving the format using v4l2_subdev_get_pad_format() there
- Dropping this field
The formats for both the ACTIVE and TRY states will then be stored in
the subdev state, unconditionally. You can retrieve the active state
with v4l2_subdev_get_locked_active_state() in tc358746_s_stream().
> + struct v4l2_fwnode_endpoint csi_vep;
> +
> + struct v4l2_ctrl_handler ctrl_hdl;
> +
> + struct regmap *regmap;
> + struct clk *refclk;
> + struct gpio_desc *reset_gpio;
> + struct regulator_bulk_data supplies[ARRAY_SIZE(tc358746_supplies)];
> +
> + struct clk_hw mclk_hw;
> + unsigned long mclk_rate;
> + u8 mclk_prediv;
> + u16 mclk_postdiv;
> +
> + unsigned long pll_rate;
> + u8 pll_post_div;
> + u16 pll_pre_div;
> + u16 pll_mul;
> +
> + struct v4l2_ctrl *sensor_pclk_ctrl;
> +
> +#define TC358746_VB_MAX_SIZE (511 * 32)
> +#define TC358746_VB_DEFAULT_SIZE (1 * 32)
> + unsigned int vb_size; /* Video buffer size in bits */
> +
> + struct phy_configure_opts_mipi_dphy dphy_cfg;
> +};
> +
> +static inline struct tc358746 *to_tc358746(struct v4l2_subdev *sd)
> +{
> + return container_of(sd, struct tc358746, sd);
> +}
> +
> +static inline struct tc358746 *clk_hw_to_tc358746(struct clk_hw *hw)
> +{
> + return container_of(hw, struct tc358746, mclk_hw);
> +}
> +
> +struct tc358746_format {
> + u32 code;
> + bool csi_format;
> + unsigned char bus_width;
> + unsigned char bpp;
> + /* Register values */
> + u8 pdformat; /* Peripheral Data Format */
> + u8 pdataf; /* Parallel Data Format Option */
> +};
> +
> +enum {
> + PDFORMAT_RAW8 = 0,
> + PDFORMAT_RAW10,
> + PDFORMAT_RAW12,
> + PDFORMAT_RGB888,
> + PDFORMAT_RGB666,
> + PDFORMAT_RGB565,
> + PDFORMAT_YUV422_8BIT,
> + /* RESERVED = 7 */
> + PDFORMAT_RAW14 = 8,
> + PDFORMAT_YUV422_10BIT,
> + PDFORMAT_YUV444,
> +};
> +
> +/* Check tc358746_src_mbus_code() if you add new formats */
> +static const struct tc358746_format tc358746_formats[] = {
> + {
> + .code = MEDIA_BUS_FMT_UYVY8_2X8,
> + .bus_width = 8,
> + .bpp = 16,
> + .pdformat = PDFORMAT_YUV422_8BIT,
> + .pdataf = PDATAF_MODE0,
> + }, {
> + .code = MEDIA_BUS_FMT_UYVY8_1X16,
> + .csi_format = true,
> + .bus_width = 16,
> + .bpp = 16,
> + .pdformat = PDFORMAT_YUV422_8BIT,
> + .pdataf = PDATAF_MODE1,
> + }, {
> + .code = MEDIA_BUS_FMT_YUYV8_1X16,
> + .csi_format = true,
> + .bus_width = 16,
> + .bpp = 16,
> + .pdformat = PDFORMAT_YUV422_8BIT,
> + .pdataf = PDATAF_MODE2,
> + }, {
> + .code = MEDIA_BUS_FMT_UYVY10_2X10,
> + .bus_width = 10,
> + .bpp = 20,
> + .pdformat = PDFORMAT_YUV422_10BIT,
> + .pdataf = PDATAF_MODE0, /* don't care */
> + }, {
> + /* in datasheet listed as YUV444 */
> + .code = MEDIA_BUS_FMT_GBR888_1X24,
> + .csi_format = true,
> + .bus_width = 24,
> + .bpp = 24,
> + .pdformat = PDFORMAT_YUV444,
This looks quite weird, does 24-bit RGB really map to the CSI-2 YUV444
data type ?
> + .pdataf = PDATAF_MODE0, /* don't care */
> + },
> +};
> +
> +/* Get n-th format for pad */
> +static const struct tc358746_format *
> +tc358746_get_format_by_idx(unsigned int pad, unsigned int index)
> +{
> + unsigned int idx = 0;
> + unsigned int i;
> +
> + if (pad >= TC358746_NR_PADS)
> + return ERR_PTR(-EINVAL);
That should be tested by the subdev core, I think you can drop the
check. Same below.
> +
> + for (i = 0; i < ARRAY_SIZE(tc358746_formats); i++) {
> + const struct tc358746_format *fmt = &tc358746_formats[i];
> +
> + if ((pad == TC358746_SOURCE && fmt->csi_format) ||
> + (pad == TC358746_SINK)) {
> + if (idx == index)
> + return fmt;
> + idx++;
> + }
> + }
> +
> + return ERR_PTR(-EINVAL);
> +}
> +
> +static const struct tc358746_format *
> +tc358746_get_format_by_code(unsigned int pad, u32 code)
> +{
> + unsigned int i;
> +
> + if (pad >= TC358746_NR_PADS)
> + return ERR_PTR(-EINVAL);
> +
> + for (i = 0; i < ARRAY_SIZE(tc358746_formats); i++) {
> + const struct tc358746_format *fmt = &tc358746_formats[i];
> +
> + if (pad == TC358746_SINK && fmt->code == code)
> + return fmt;
> +
> + if (pad == TC358746_SOURCE && fmt->csi_format &&
> + fmt->code == code)
> + return fmt;
You could also write
if (pad == TC358746_SOURCE && !fmt->csi_format)
continue;
if (fmt->code == code)
return fmt;
Up to you.
> + }
> +
> + return ERR_PTR(-EINVAL);
> +}
> +
> +static u32 tc358746_src_mbus_code(u32 code)
> +{
> + switch (code) {
> + case MEDIA_BUS_FMT_UYVY8_2X8:
> + return MEDIA_BUS_FMT_UYVY8_1X16;
> + case MEDIA_BUS_FMT_UYVY10_2X10:
> + return MEDIA_BUS_FMT_UYVY10_1X20;
> + default:
> + return code;
> + }
> +}
> +
> +static bool tc358746_writeable_reg(struct device *dev, unsigned int reg)
> +{
> + switch (reg) {
> + case SYSCTL_REG ... CSI_START_REG:
> + return true;
> + default:
> + return false;
> + }
> +}
> +
> +static bool tc358746_readable_reg(struct device *dev, unsigned int reg)
> +{
> + switch (reg) {
> + case CHIPID_REG ... CSI_START_REG:
> + return true;
> + default:
> + return false;
> + }
> +}
> +
> +static const struct regmap_config tc358746_regmap_config = {
> + .name = "tc358746",
> + .reg_bits = 16,
> + .val_bits = 16,
> + .max_register = CSI_START_REG,
> + .writeable_reg = tc358746_writeable_reg,
> + .readable_reg = tc358746_readable_reg,
> + .reg_format_endian = REGMAP_ENDIAN_BIG,
> + .val_format_endian = REGMAP_ENDIAN_BIG,
> +};
> +
> +static int tc358746_write(struct tc358746 *tc358746, u32 reg, u32 val)
> +{
> + size_t count;
> +
> + /* 32-bit registers starting from CLW_DPHYCONTTX */
> + count = reg < CLW_DPHYCONTTX_REG ? 1 : 2;
> +
> + return regmap_bulk_write(tc358746->regmap, reg, &val, count);
> +}
> +
> +static int tc358746_read(struct tc358746 *tc358746, u32 reg, u32 *val)
> +{
> + size_t count;
> +
> + /* 32-bit registers starting from CLW_DPHYCONTTX */
> + count = reg < CLW_DPHYCONTTX_REG ? 1 : 2;
> + *val = 0;
> +
> + return regmap_bulk_read(tc358746->regmap, reg, val, count);
> +}
> +
> +static int
> +tc358746_update_bits(struct tc358746 *tc358746, u32 reg, u32 mask, u32 val)
> +{
> + u32 tmp, orig;
> + int err;
> +
> + err = tc358746_read(tc358746, reg, &orig);
> + if (err)
> + return err;
> +
> + tmp = orig & ~mask;
> + tmp |= val & mask;
> +
> + return tc358746_write(tc358746, reg, tmp);
> +}
> +
> +static int tc358746_set_bits(struct tc358746 *tc358746, u32 reg, u32 bits)
> +{
> + return tc358746_update_bits(tc358746, reg, bits, bits);
> +}
> +
> +static int tc358746_clear_bits(struct tc358746 *tc358746, u32 reg, u32 bits)
> +{
> + return tc358746_update_bits(tc358746, reg, bits, 0);
> +}
> +
> +static int tc358746_sw_reset(struct tc358746 *tc358746)
> +{
> + int err;
> +
> + err = tc358746_set_bits(tc358746, SYSCTL_REG, SRESET);
> + if (err)
> + return err;
> +
> + udelay(10);
> +
> + return tc358746_clear_bits(tc358746, SYSCTL_REG, SRESET);
> +}
> +
> +static int
> +tc358746_apply_pll_config(struct tc358746 *tc358746)
> +{
> + u8 post = tc358746->pll_post_div;
> + u16 pre = tc358746->pll_pre_div;
> + u16 mul = tc358746->pll_mul;
> + u32 val, mask;
> + int err;
> +
> + err = tc358746_read(tc358746, PLLCTL1_REG, &val);
> + if (err)
> + return err;
> +
> + /* Don't touch the PLL if running */
> + if (FIELD_GET(PLL_EN, val) == 1)
> + return 0;
> +
> + /* Pre-div and Multiplicator have a internal +1 logic */
> + val = PLL_PRD(pre - 1) | PLL_FBD(mul - 1);
> + mask = PLL_PRD_MASK | PLL_FBD_MASK;
> + err = tc358746_update_bits(tc358746, PLLCTL0_REG, mask, val);
> + if (err)
> + return err;
> +
> + val = PLL_FRS(ilog2(post)) | RESETB | PLL_EN;
> + mask = PLL_FRS_MASK | RESETB | PLL_EN;
> + tc358746_update_bits(tc358746, PLLCTL1_REG, mask, val);
> + if (err)
> + return err;
> +
> + udelay(1000);
> +
> + return tc358746_set_bits(tc358746, PLLCTL1_REG, CKEN);
> +}
> +
> +static int tc358746_apply_misc_config(struct tc358746 *tc358746)
> +{
> + struct device *dev = tc358746->sd.dev;
> + const struct tc358746_format *fmt;
> + u32 val;
> + int err;
> +
> + fmt = tc358746_get_format_by_code(TC358746_SINK, tc358746->mbusfmt.code);
> + if (IS_ERR(fmt))
> + return PTR_ERR(fmt);
mbusfmt.code is supposed to have been validated, so you can drop the
error check here.
> +
> + /* Self defined CSI user data type id's are not supported yet */
> + val = PDFMT(fmt->pdformat);
> + dev_dbg(dev, "DATAFMT: 0x%x\n", val);
> + err = tc358746_write(tc358746, DATAFMT_REG, val);
> + if (err)
> + return err;
> +
> + val = PDATAF(fmt->pdataf);
> + dev_dbg(dev, "CONFCTL[PDATAF]: 0x%x\n", fmt->pdataf);
> + err = tc358746_update_bits(tc358746, CONFCTL_REG, PDATAF_MASK, val);
> + if (err)
> + return err;
> +
> + val = tc358746->vb_size / 32;
> + dev_dbg(dev, "FIFOCTL: %u (0x%x)\n", val, val);
> + err = tc358746_write(tc358746, FIFOCTL_REG, val);
> + if (err)
> + return err;
> +
> + /* Total number of bytes for each line/width */
> + val = tc358746->mbusfmt.width * fmt->bpp / 8;
> + dev_dbg(dev, "WORDCNT: %u (0x%x)\n", val, val);
> + return tc358746_write(tc358746, WORDCNT_REG, val);
> +}
> +
> +#ifndef MHZ
Where would it be previously defined ? This sounds like asking for
trouble later.
> +#define MHZ (1000 * 1000)
> +#endif
> +
> +/* Use MHz as base so the div needs no u64 */
> +static u32 tc358746_cfg_to_cnt(unsigned int cfg_val,
> + unsigned int clk_mhz,
> + unsigned int time_base)
> +{
> + return DIV_ROUND_UP(cfg_val * clk_mhz, time_base);
> +}
> +
> +static u32 tc358746_ps_to_cnt(unsigned int cfg_val,
> + unsigned int clk_mhz)
> +{
> + return tc358746_cfg_to_cnt(cfg_val, clk_mhz, USEC_PER_SEC);
> +}
> +
> +static u32 tc358746_us_to_cnt(unsigned int cfg_val,
> + unsigned int clk_mhz)
> +{
> + return tc358746_cfg_to_cnt(cfg_val, clk_mhz, 1);
> +}
> +
> +static int tc358746_apply_dphy_config(struct tc358746 *tc358746)
> +{
> + struct phy_configure_opts_mipi_dphy *cfg = &tc358746->dphy_cfg;
> + bool non_cont_clk = !!(tc358746->csi_vep.bus.mipi_csi2.flags &
> + V4L2_MBUS_CSI2_NONCONTINUOUS_CLOCK);
> + struct device *dev = tc358746->sd.dev;
> + unsigned long hs_byte_clk, hf_clk;
> + u32 val, val2, lptxcnt;
> + int err;
> +
> + /* The hs_byte_clk is also called SYSCLK in the excel sheet */
> + hs_byte_clk = cfg->hs_clk_rate / 8;
> + hs_byte_clk /= MHZ;
> + hf_clk = hs_byte_clk / 2;
> +
> + val = tc358746_us_to_cnt(cfg->init, hf_clk) - 1;
> + dev_dbg(dev, "LINEINITCNT: %u (0x%x)\n", val, val);
> + err = tc358746_write(tc358746, LINEINITCNT_REG, val);
> + if (err)
> + return err;
> +
> + val = tc358746_ps_to_cnt(cfg->lpx, hs_byte_clk) - 1;
> + lptxcnt = val;
> + dev_dbg(dev, "LPTXTIMECNT: %u (0x%x)\n", val, val);
> + err = tc358746_write(tc358746, LPTXTIMECNT_REG, val);
> + if (err)
> + return err;
> +
> + val = tc358746_ps_to_cnt(cfg->clk_prepare, hs_byte_clk) - 1;
> + val2 = tc358746_ps_to_cnt(cfg->clk_zero, hs_byte_clk) - 1;
> + dev_dbg(dev, "TCLK_PREPARECNT: %u (0x%x)\n", val, val);
> + dev_dbg(dev, "TCLK_ZEROCNT: %u (0x%x)\n", val2, val2);
> + dev_dbg(dev, "TCLK_HEADERCNT: 0x%x\n",
> + (u32)(TCLK_PREPARECNT(val) | TCLK_ZEROCNT(val2)));
> + err = tc358746_write(tc358746, TCLK_HEADERCNT_REG,
> + TCLK_PREPARECNT(val) | TCLK_ZEROCNT(val2));
> + if (err)
> + return err;
> +
> + val = tc358746_ps_to_cnt(cfg->clk_trail, hs_byte_clk);
> + dev_dbg(dev, "TCLK_TRAILCNT: %u (0x%x)\n", val, val);
> + err = tc358746_write(tc358746, TCLK_TRAILCNT_REG, val);
> + if (err)
> + return err;
> +
> + val = tc358746_ps_to_cnt(cfg->hs_prepare, hs_byte_clk) - 1;
> + val2 = tc358746_ps_to_cnt(cfg->hs_zero, hs_byte_clk) - 1;
> + dev_dbg(dev, "THS_PREPARECNT: %u (0x%x)\n", val, val);
> + dev_dbg(dev, "THS_ZEROCNT: %u (0x%x)\n", val2, val2);
> + dev_dbg(dev, "THS_HEADERCNT: 0x%x\n",
> + (u32)(THS_PREPARECNT(val) | THS_ZEROCNT(val2)));
> + err = tc358746_write(tc358746, THS_HEADERCNT_REG,
> + THS_PREPARECNT(val) | THS_ZEROCNT(val2));
> + if (err)
> + return err;
> +
> + /* TWAKEUP > 1ms in lptxcnt steps */
> + val = tc358746_us_to_cnt(cfg->wakeup, hs_byte_clk);
> + val = val / (lptxcnt + 1) - 1;
> + dev_dbg(dev, "TWAKEUP: %u (0x%x)\n", val, val);
> + err = tc358746_write(tc358746, TWAKEUP_REG, val);
> + if (err)
> + return err;
> +
> + val = tc358746_ps_to_cnt(cfg->clk_post, hs_byte_clk);
> + dev_dbg(dev, "TCLK_POSTCNT: %u (0x%x)\n", val, val);
> + err = tc358746_write(tc358746, TCLK_POSTCNT_REG, val);
> + if (err)
> + return err;
> +
> + val = tc358746_ps_to_cnt(cfg->hs_trail, hs_byte_clk);
> + dev_dbg(dev, "THS_TRAILCNT: %u (0x%x)\n", val, val);
> + err = tc358746_write(tc358746, THS_TRAILCNT_REG, val);
> + if (err)
> + return err;
> +
> + dev_dbg(dev, "CONTCLKMODE: %u", non_cont_clk ? 0 : 1);
> + return tc358746_write(tc358746, TXOPTIONCNTRL_REG, non_cont_clk ? 0 : 1);
> +}
> +
> +#define MAX_DATA_LANES 4
> +
> +static int tc358746_enable_csi_lanes(struct tc358746 *tc358746, int enable)
> +{
> + unsigned int lanes = tc358746->dphy_cfg.lanes;
> + unsigned int lane;
> + u32 reg, val;
> + int err;
> +
> + err = tc358746_update_bits(tc358746, CONFCTL_REG, DATALANE_MASK,
> + lanes - 1);
> + if (err)
> + return err;
> +
> + /* Clock lane */
> + val = enable ? 0 : LANEDISABLE;
> + dev_dbg(tc358746->sd.dev, "CLW_CNTRL: 0x%x\n", val);
> + err = tc358746_write(tc358746, CLW_CNTRL_REG, val);
> + if (err)
> + return err;
> +
> + for (lane = 0; lane < MAX_DATA_LANES; lane++) {
> + /* Data lanes */
> + reg = D0W_CNTRL_REG + lane * 0x4;
> + val = (enable && lane < lanes) ? 0 : LANEDISABLE;
> +
> + dev_dbg(tc358746->sd.dev, "D%uW_CNTRL: 0x%x\n", lane, val);
> + err = tc358746_write(tc358746, reg, val);
> + if (err)
> + return err;
> + }
> +
> + val = 0;
> + if (enable) {
> + /* Clock lane */
> + val |= BIT(0);
> +
> + /* Data lanes */
> + for (lane = 1; lane <= lanes; lane++)
> + val |= BIT(lane);
> + }
> +
> + dev_dbg(tc358746->sd.dev, "HSTXVREGEN: 0x%x\n", val);
> + return tc358746_write(tc358746, HSTXVREGEN_REG, val);
> +}
> +
> +static int tc358746_enable_csi_module(struct tc358746 *tc358746, int enable)
> +{
> + unsigned int lanes = tc358746->dphy_cfg.lanes;
> + int err;
> +
> + /*
> + * START and STRT are only reseted/disabled by sw reset. This is
> + * required to put the lane state back into LP-11 state. The sw reset
> + * don't reset register values.
> + */
> + if (!enable)
> + return tc358746_sw_reset(tc358746);
> +
> + err = tc358746_write(tc358746, STARTCNTRL_REG, START);
> + if (err)
> + return err;
> +
> + err = tc358746_write(tc358746, CSI_START_REG, STRT);
> + if (err)
> + return err;
> +
> + /* CSI_CONTROL_REG is only indirect accessible */
> + return tc358746_write(tc358746, CSI_CONFW_REG,
> + MODE(MODE_SET) |
> + ADDRESS(CSI_CONTROL_ADDRESS) |
> + DATA(CSI_MODE | TXHSMD | NOL(lanes - 1)));
> +}
> +
> +static int tc358746_enable_parallel_port(struct tc358746 *tc358746, int enable)
> +{
> + int err;
> +
> + if (enable) {
> + err = tc358746_write(tc358746, PP_MISC_REG, 0);
> + if (err)
> + return err;
> +
> + return tc358746_set_bits(tc358746, CONFCTL_REG, PPEN);
> + }
> +
> + err = tc358746_set_bits(tc358746, PP_MISC_REG, FRMSTOP);
> + if (err)
> + return err;
> +
> + err = tc358746_clear_bits(tc358746, CONFCTL_REG, PPEN);
> + if (err)
> + return err;
> +
> + return tc358746_set_bits(tc358746, PP_MISC_REG, RSTPTR);
> +}
> +
> +static inline struct v4l2_subdev *tc358746_get_remote_sd(struct media_pad *pad)
> +{
> + pad = media_pad_remote_pad_first(pad);
> + if (!pad)
> + return NULL;
> +
> + return media_entity_to_v4l2_subdev(pad->entity);
> +}
> +
> +static int tc358746_s_stream(struct v4l2_subdev *sd, int enable)
> +{
> + struct tc358746 *tc358746 = to_tc358746(sd);
> + struct v4l2_subdev *src;
> + int err;
> +
> + dev_dbg(sd->dev, "%sable\n", enable ? "en" : "dis");
> +
> + src = tc358746_get_remote_sd(&tc358746->pads[TC358746_SINK]);
> + if (!src)
> + return -EPIPE;
> +
> + if (enable) {
> + err = pm_runtime_resume_and_get(sd->dev);
> + if (err)
> + return err;
> +
> + err = tc358746_enable_csi_lanes(tc358746, 1);
> + if (err) {
> + pm_runtime_mark_last_busy(sd->dev);
> + pm_runtime_put_sync_autosuspend(sd->dev);
> + return err;
Looks like a candidate for a goto statement.
> + }
> +
> + err = tc358746_enable_csi_module(tc358746, 1);
> + if (err) {
> + pm_runtime_mark_last_busy(sd->dev);
> + pm_runtime_put_sync_autosuspend(sd->dev);
> + return err;
> + }
> +
> + err = tc358746_enable_parallel_port(tc358746, 1);
> + if (err) {
> + pm_runtime_mark_last_busy(sd->dev);
> + pm_runtime_put_sync_autosuspend(sd->dev);
> + return err;
> + }
> +
> + err = v4l2_subdev_call(src, video, s_stream, 1);
> + if (err) {
> + pm_runtime_mark_last_busy(sd->dev);
> + pm_runtime_put_sync_autosuspend(sd->dev);
> + }
> +
> + return err;
> + }
> +
> + /*
> + * Lane disable trigger state change from LP-11 to LP-00
> + * therefore it must happen before the CSI modile is disabled.
> + */
> + err = tc358746_enable_csi_lanes(tc358746, 0);
> + if (err)
> + return err;
> +
> + err = tc358746_enable_csi_module(tc358746, 0);
> + if (err)
> + return err;
> +
> + err = tc358746_enable_parallel_port(tc358746, 0);
> + if (err)
> + return err;
> +
> + pm_runtime_mark_last_busy(sd->dev);
> + pm_runtime_put_sync_autosuspend(sd->dev);
> +
> + return v4l2_subdev_call(src, video, s_stream, 0);
> +}
> +
> +static int tc358746_enum_mbus_code(struct v4l2_subdev *sd,
> + struct v4l2_subdev_state *sd_state,
> + struct v4l2_subdev_mbus_code_enum *code)
> +{
> + const struct tc358746_format *fmt;
> +
> + fmt = tc358746_get_format_by_idx(code->pad, code->index);
> + if (IS_ERR(fmt))
> + return PTR_ERR(fmt);
> +
> + code->code = fmt->code;
> +
> + return 0;
> +}
> +
> +static struct v4l2_mbus_framefmt *
> +__tc358746_get_pad_format(struct v4l2_subdev *sd,
> + struct v4l2_subdev_state *sd_state,
> + unsigned int pad, u32 which)
> +{
> + struct tc358746 *tc358746 = to_tc358746(sd);
> +
> + switch (which) {
> + case V4L2_SUBDEV_FORMAT_TRY:
> + return v4l2_subdev_get_try_format(sd, sd_state, pad);
> + case V4L2_SUBDEV_FORMAT_ACTIVE:
> + return &tc358746->mbusfmt;
> + default:
> + return NULL;
> + }
> +}
> +
> +static int tc358746_get_fmt(struct v4l2_subdev *sd,
> + struct v4l2_subdev_state *sd_state,
> + struct v4l2_subdev_format *format)
> +{
> + struct tc358746 *tc358746 = to_tc358746(sd);
> +
> + if (format->pad >= TC358746_NR_PADS)
> + return -EINVAL;
> +
> + format->format = tc358746->mbusfmt;
> + if (format->pad == TC358746_SOURCE)
> + format->format.code = tc358746_src_mbus_code(tc358746->mbusfmt.code);
> +
> + return 0;
> +}
> +
> +static int tc358746_set_fmt(struct v4l2_subdev *sd,
> + struct v4l2_subdev_state *sd_state,
> + struct v4l2_subdev_format *format)
> +{
> + struct v4l2_mbus_framefmt *mbusformat;
> + const struct tc358746_format *fmt;
> +
> + if (format->pad >= TC358746_NR_PADS)
> + return -EINVAL;
> +
> + /* The src follows the properties from the sink */
> + if (format->pad == TC358746_SOURCE)
> + return tc358746_get_fmt(sd, sd_state, format);
> +
> + mbusformat = __tc358746_get_pad_format(sd, sd_state, format->pad,
> + format->which);
> + if (!mbusformat)
> + return -EINVAL;
> +
> + fmt = tc358746_get_format_by_code(format->pad, format->format.code);
> + if (IS_ERR(fmt))
> + fmt = tc358746_get_format_by_code(format->pad, tc358746_def_fmt.code);
> +
> + format->format.code = fmt->code;
> + format->format.field = V4L2_FIELD_NONE;
> +
> + dev_dbg(sd->dev, "Update format: %ux%u code:0x%x -> %ux%u code:0x%x",
> + mbusformat->width, mbusformat->height, mbusformat->code,
> + format->format.width, format->format.height, format->format.code);
> +
> + *mbusformat = format->format;
> +
> + return 0;
> +}
> +
> +static unsigned long tc358746_find_pll_settings(struct tc358746 *tc358746,
> + unsigned long refclk,
> + unsigned long fout)
> +
> +{
> + struct device *dev = tc358746->sd.dev;
> + unsigned long best_freq = 0;
> + u32 min_delta = 0xffffffff;
> + u16 prediv_max = 17;
> + u16 prediv_min = 1;
> + u16 m_best, mul;
> + u16 p_best, p;
> + u8 postdiv;
> +
> + if (fout > 1000 * MHZ) {
> + dev_err(dev, "HS-Clock above 1 Ghz are not supported\n");
> + return 0;
> + } else if (fout >= 500 * MHZ)
> + postdiv = 1;
> + else if (fout >= 250 * MHZ)
> + postdiv = 2;
> + else if (fout >= 125 * MHZ)
> + postdiv = 4;
> + else
> + postdiv = 8;
> +
> + for (p = prediv_min; p <= prediv_max; p++) {
> + unsigned long delta, fin;
> + u64 tmp;
> +
> + fin = DIV_ROUND_CLOSEST(refclk, p);
> + if (fin < 4 * MHZ || fin > 40 * MHZ)
> + continue;
> +
> + tmp = fout * p * postdiv;
> + do_div(tmp, fin);
> + mul = tmp;
> + if (mul > 511)
> + continue;
> +
> + tmp = mul * fin;
> + do_div(tmp, p * postdiv);
> +
> + delta = abs(fout - tmp);
> + if (delta < min_delta) {
> + p_best = p;
> + m_best = mul;
> + min_delta = delta;
> + best_freq = tmp;
> + };
> +
> + if (delta == 0)
> + break;
> + };
> +
> + if (!best_freq) {
> + dev_err(dev, "Failed find PLL frequency\n");
> + return 0;
> + }
> +
> + tc358746->pll_post_div = postdiv;
> + tc358746->pll_pre_div = p_best;
> + tc358746->pll_mul = m_best;
> +
> + if (best_freq != fout)
> + dev_warn(dev, "Request PLL freq:%lu, found PLL freq:%lu\n",
> + fout, best_freq);
> +
> + dev_dbg(dev, "Found PLL settings: freq:%lu prediv:%u multi:%u postdiv:%u\n",
> + best_freq, p_best, m_best, postdiv);
> +
> + return best_freq;
> +}
> +
> +#define TC358746_PRECISION 10
> +
> +static int
> +tc358746_link_validate(struct v4l2_subdev *sd, struct media_link *link,
> + struct v4l2_subdev_format *source_fmt,
> + struct v4l2_subdev_format *sink_fmt)
> +{
> + struct tc358746 *tc358746 = to_tc358746(sd);
> + unsigned long csi_bitrate, sensor_bitrate;
> + const struct tc358746_format *fmt;
> + unsigned int fifo_sz, tmp, n;
> + s64 sensor_pclk_rate;
> +
> + /* Check the FIFO settings */
> + fmt = tc358746_get_format_by_code(TC358746_SINK, tc358746->mbusfmt.code);
> + if (IS_ERR(fmt))
> + return PTR_ERR(fmt);
> +
> + sensor_pclk_rate = v4l2_ctrl_g_ctrl_int64(tc358746->sensor_pclk_ctrl);
> + sensor_bitrate = sensor_pclk_rate * fmt->bus_width;
> +
> + csi_bitrate = tc358746->dphy_cfg.lanes * tc358746->pll_rate;
> +
> + dev_dbg(tc358746->sd.dev,
> + "Fifo settings params: sensor-bitrate:%lu csi-bitrate:%lu",
> + sensor_bitrate, csi_bitrate);
> +
> + /* Avoid possible FIFO overflows */
> + if (csi_bitrate < sensor_bitrate) {
> + dev_err(sd->dev,
> + "Link validation failed csi-bitrate:%lu < sensor-bitrate:%lu\n",
> + csi_bitrate, sensor_bitrate);
> + return -EINVAL;
> + }
> +
> + /* Best case */
> + if (csi_bitrate == sensor_bitrate) {
> + tc358746->vb_size = TC358746_VB_DEFAULT_SIZE;
> + goto out;
> + }
> +
> + /*
> + * Avoid possible FIFO underflow in case of
> + * csi_bitrate > sensor_bitrate. For such case the chip has a internal
> + * fifo which can be used to delay the line output.
> + *
> + * Fifo size calculation:
> + *
> + * fifo-sz, image-width - in bits
> + * sbr - sensor_bitrate in bits/s
> + * csir - csi_bitrate in bits/s
> + *
> + * 1 1 1
> + * image-width * --- + fifo-sz --- >= ---- * image-width
> + * sbr sbr csir
> + *
> + * fifo-sz >= abs(sbr/csir * image-width - image-width)
> + * `-----´
> + * n
> + *
> + */
> +
> + sensor_bitrate /= TC358746_PRECISION;
> + n = csi_bitrate / sensor_bitrate;
> + tmp = (tc358746->mbusfmt.width * TC358746_PRECISION) / n;
> + fifo_sz = tc358746->mbusfmt.width - tmp;
> + fifo_sz *= fmt->bpp;
> + tc358746->vb_size = round_up(fifo_sz, 32);
> +
Please also call v4l2_subdev_link_validate_default() here.
I wonder if the above calculation wouldn't be better performed in
.s_stream() (or rather in a function being called by .s_stream()) when
enabling streaming.
> +out:
> + dev_dbg(tc358746->sd.dev,
> + "Found FIFO size[bits]:%u -> aligned to size[bits]:%u\n",
> + fifo_sz, tc358746->vb_size);
> +
> + return tc358746->vb_size > TC358746_VB_MAX_SIZE ? -EINVAL : 0;
> +}
> +
> +static int tc358746_get_mbus_config(struct v4l2_subdev *sd, unsigned int pad,
> + struct v4l2_mbus_config *config)
> +{
> + struct tc358746 *tc358746 = to_tc358746(sd);
> +
> + if (pad != TC358746_SOURCE)
> + return -EINVAL;
> +
> + config->type = V4L2_MBUS_CSI2_DPHY;
> + config->bus.mipi_csi2 = tc358746->csi_vep.bus.mipi_csi2;
> +
> + return 0;
> +}
> +
> +static int tc358746_link_setup(struct media_entity *entity,
> + const struct media_pad *local,
> + const struct media_pad *remote, u32 flags)
> +{
> + struct v4l2_subdev *sd = media_entity_to_v4l2_subdev(entity);
> + struct v4l2_subdev *sensor_sd =
> + media_entity_to_v4l2_subdev(remote->entity);
> + struct tc358746 *tc358746 = to_tc358746(sd);
> + struct device *dev = sd->dev;
> + struct v4l2_ctrl *ctrl;
> +
> + /* no special requirements on source pads */
> + if (local->flags & MEDIA_PAD_FL_SOURCE)
> + return 0;
> +
> + dev_dbg(dev, "link setup '%s':%d->'%s':%d[%d]",
> + remote->entity->name, remote->index, local->entity->name,
> + local->index, flags & MEDIA_LNK_FL_ENABLED);
> +
> + /* Required for the fifo calculation */
> + ctrl = v4l2_ctrl_find(sensor_sd->ctrl_handler, V4L2_CID_PIXEL_RATE);
> + if (!ctrl) {
> + dev_err(dev, "Subdev [%s] must support V4L2_CID_PIXEL_RATE\n",
> + sensor_sd->name);
> + return -EINVAL;
> + }
> + tc358746->sensor_pclk_ctrl = ctrl;
> +
> + return 0;
> +}
> +
> +int __maybe_unused
> +tc358746_g_register(struct v4l2_subdev *sd, struct v4l2_dbg_register *reg)
> +{
> + struct tc358746 *tc358746 = to_tc358746(sd);
> +
> + /* 32-bit registers starting from CLW_DPHYCONTTX */
> + reg->size = reg->reg < CLW_DPHYCONTTX_REG ? 2 : 4;
> +
> + if (pm_runtime_resume_and_get(sd->dev)) {
> + dev_err(sd->dev, "Failed to resume the device\n");
> + return 0;
> + }
> +
> + tc358746_read(tc358746, reg->reg, (u32 *)®->val);
> +
> + pm_runtime_mark_last_busy(sd->dev);
> + pm_runtime_put_sync_autosuspend(sd->dev);
> +
> + return 0;
> +}
> +
> +int __maybe_unused
> +tc358746_s_register(struct v4l2_subdev *sd, const struct v4l2_dbg_register *reg)
> +{
> + struct tc358746 *tc358746 = to_tc358746(sd);
> +
> + if (pm_runtime_resume_and_get(sd->dev)) {
> + dev_err(sd->dev, "Failed to resume the device\n");
> + return 0;
> + }
> +
> + tc358746_write(tc358746, (u32)reg->reg, (u32)reg->val);
> +
> + pm_runtime_mark_last_busy(sd->dev);
> + pm_runtime_put_sync_autosuspend(sd->dev);
> +
> + return 0;
> +}
> +
> +static const struct v4l2_subdev_core_ops tc358746_core_ops = {
> +#ifdef CONFIG_VIDEO_ADV_DEBUG
> + .g_register = tc358746_g_register,
> + .s_register = tc358746_s_register,
> +#endif
Have you found this to be useful ?
> +};
> +
> +static const struct v4l2_subdev_video_ops tc358746_video_ops = {
> + .s_stream = tc358746_s_stream,
> +};
> +
> +static const struct v4l2_subdev_pad_ops tc358746_pad_ops = {
> + .enum_mbus_code = tc358746_enum_mbus_code,
> + .set_fmt = tc358746_set_fmt,
> + .get_fmt = tc358746_get_fmt,
> + .link_validate = tc358746_link_validate,
> + .get_mbus_config = tc358746_get_mbus_config,
> +};
> +
> +static const struct v4l2_subdev_ops tc358746_ops = {
> + .core = &tc358746_core_ops,
> + .video = &tc358746_video_ops,
> + .pad = &tc358746_pad_ops,
> +};
> +
> +static const struct media_entity_operations tc358746_entity_ops = {
> + .get_fwnode_pad = v4l2_subdev_get_fwnode_pad_1_to_1,
> + .link_setup = tc358746_link_setup,
> + .link_validate = v4l2_subdev_link_validate,
> +};
> +
> +static int tc358746_mclk_enable(struct clk_hw *hw)
> +{
> + struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
> + unsigned int div;
> + u32 val;
> + int err;
> +
> + div = tc358746->mclk_postdiv / 2;
> + val = MCLK_HIGH(div - 1) | MCLK_LOW(div - 1);
> + dev_dbg(tc358746->sd.dev, "MCLKCTL: %u (0x%x)\n", val, val);
> + err = tc358746_write(tc358746, MCLKCTL_REG, val);
> + if (err)
> + return err;
> +
> + if (tc358746->mclk_prediv == 8)
> + val = MCLKDIV(MCLKDIV_8);
> + else if (tc358746->mclk_prediv == 4)
> + val = MCLKDIV(MCLKDIV_4);
> + else
> + val = MCLKDIV(MCLKDIV_2);
> +
> + dev_dbg(tc358746->sd.dev, "CLKCTL[MCLKDIV]: %u (0x%x)\n", val, val);
> + return tc358746_update_bits(tc358746, CLKCTL_REG, MCLKDIV_MASK, val);
> +}
> +
> +static void tc358746_mclk_disable(struct clk_hw *hw)
> +{
> + struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
> +
> + tc358746_write(tc358746, MCLKCTL_REG, 0);
> +}
> +
> +static long
> +tc358746_find_mclk_settings(struct tc358746 *tc358746, unsigned long mclk_rate)
> +{
> + unsigned long pll_rate = tc358746->pll_rate;
> + const unsigned char prediv[] = { 2, 4, 8 };
> + unsigned int mclk_prediv, mclk_postdiv;
> + struct device *dev = tc358746->sd.dev;
> + unsigned int postdiv, mclkdiv;
> + unsigned long best_mclk_rate;
> + unsigned int i;
> +
> + /*
> + * MCLK-Div
> + * -------------------´`---------------------
> + * ´ `
> + * +-------------+ +------------------------+
> + * | MCLK-PreDiv | | MCLK-PostDiv |
> + * PLL --> | (2/4/8) | --> | (mclk_low + mclk_high) | --> MCLK
> + * +-------------+ +------------------------+
> + *
> + * The register value of mclk_low/high is mclk_low/high+1, i.e.:
> + * mclk_low/high = 1 --> 2 MCLK-Ref Counts
> + * mclk_low/high = 255 --> 256 MCLK-Ref Counts == max.
> + * If mclk_low and mclk_high are 0 then MCLK is disabled.
> + *
> + * Keep it simple and support 50/50 duty cycles only for now,
> + * so the calc will be:
> + *
> + * MCLK = PLL / (MCLK-PreDiv * 2 * MCLK-PostDiv)
> + */
> +
> + if (mclk_rate == tc358746->mclk_rate)
> + return mclk_rate;
> +
> + /* Highest possible rate */
> + mclkdiv = pll_rate / mclk_rate;
> + if (mclkdiv <= 8) {
> + mclk_prediv = 2;
> + mclk_postdiv = 4;
> + best_mclk_rate = pll_rate / (2 * 4);
> + goto out;
> + }
> +
> + /* First check the prediv */
> + for (i = 0; i < ARRAY_SIZE(prediv); i++) {
> + postdiv = mclkdiv / prediv[i];
> +
> + if (postdiv % 2)
> + continue;
> +
> + if (postdiv >= 4 && postdiv <= 512) {
> + mclk_prediv = prediv[i];
> + mclk_postdiv = postdiv;
> + best_mclk_rate = pll_rate / (prediv[i] * postdiv);
> + goto out;
> + }
> + }
> +
> + /* No suitable prediv found, so try to adjust the postdiv */
> + for (postdiv = 4; postdiv <= 512; postdiv += 2) {
> + unsigned int pre;
> +
> + pre = mclkdiv / postdiv;
> + if (pre == 2 || pre == 4 || pre == 8) {
> + mclk_prediv = pre;
> + mclk_postdiv = postdiv;
> + best_mclk_rate = pll_rate / (pre * postdiv);
> + goto out;
> + }
> + }
> +
> + /* The MCLK <-> PLL gap is to high -> use largest possible div */
> + mclk_prediv = 8;
> + mclk_postdiv = 512;
> + best_mclk_rate = pll_rate / (8 * 512);
> +
> +out:
> + tc358746->mclk_prediv = mclk_prediv;
> + tc358746->mclk_postdiv = mclk_postdiv;
> + tc358746->mclk_rate = best_mclk_rate;
> +
> + if (best_mclk_rate != mclk_rate)
> + dev_warn(dev, "Request MCLK freq:%lu, found MCLK freq:%lu\n",
> + mclk_rate, best_mclk_rate);
> +
> + dev_dbg(dev, "Found MCLK settings: freq:%lu prediv:%u postdiv:%u\n",
> + best_mclk_rate, mclk_prediv, mclk_postdiv);
> +
> + return best_mclk_rate;
> +}
> +
> +unsigned long tc358746_recalc_rate(struct clk_hw *hw, unsigned long parent_rate)
> +{
> + struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
> + unsigned int prediv, postdiv;
> + u32 val;
> + int err;
> +
> + err = tc358746_read(tc358746, MCLKCTL_REG, &val);
> + if (err)
> + return 0;
> +
> + postdiv = FIELD_GET(MCLK_LOW_MASK, val) + 1;
> + postdiv += FIELD_GET(MCLK_HIGH_MASK, val) + 1;
> +
> + err = tc358746_read(tc358746, CLKCTL_REG, &val);
> + if (err)
> + return 0;
> +
> + prediv = FIELD_GET(MCLKDIV_MASK, val);
> + if (prediv == MCLKDIV_8)
> + prediv = 8;
> + else if (prediv == MCLKDIV_4)
> + prediv = 4;
> + else
> + prediv = 2;
> +
> + return tc358746->pll_rate / (prediv * postdiv);
> +}
> +
> +static long tc358746_mclk_round_rate(struct clk_hw *hw, unsigned long rate,
> + unsigned long *parent_rate)
> +{
> + struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
> +
> + *parent_rate = tc358746->pll_rate;
> +
> + return tc358746_find_mclk_settings(tc358746, rate);
> +}
> +
> +static int tc358746_mclk_set_rate(struct clk_hw *hw, unsigned long rate,
> + unsigned long parent_rate)
> +{
> + struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
> +
> + tc358746_find_mclk_settings(tc358746, rate);
> +
> + return tc358746_mclk_enable(hw);
> +}
> +
> +static const struct clk_ops tc358746_mclk_ops = {
> + .enable = tc358746_mclk_enable,
> + .disable = tc358746_mclk_disable,
> + .recalc_rate = tc358746_recalc_rate,
> + .round_rate = tc358746_mclk_round_rate,
> + .set_rate = tc358746_mclk_set_rate,
> +};
> +
> +static int tc358746_notify_bound(struct v4l2_async_notifier *notifier,
> + struct v4l2_subdev *sd,
> + struct v4l2_async_subdev *asd)
> +{
> + struct tc358746 *tc358746 =
> + container_of(notifier, struct tc358746, notifier);
> + struct media_pad *sink = &tc358746->pads[TC358746_SINK];
> +
> + return v4l2_create_fwnode_links_to_pad(sd, sink, MEDIA_LNK_FL_ENABLED);
> +}
> +
> +static const struct v4l2_async_notifier_operations tc358746_notify_ops = {
> + .bound = tc358746_notify_bound,
> +};
> +
> +static int tc358746_async_register(struct tc358746 *tc358746)
> +{
> + struct v4l2_fwnode_endpoint vep = {
> + .bus_type = V4L2_MBUS_PARALLEL,
> + };
> + struct v4l2_async_subdev *asd;
> + struct fwnode_handle *ep;
> + int err;
> +
> + ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(tc358746->sd.dev),
> + TC358746_SINK, 0, 0);
> + if (!ep)
> + return -ENOTCONN;
> +
> + err = v4l2_fwnode_endpoint_parse(ep, &vep);
> + if (err) {
> + fwnode_handle_put(ep);
> + return err;
> + }
> +
> + v4l2_async_nf_init(&tc358746->notifier);
> + asd = v4l2_async_nf_add_fwnode_remote(&tc358746->notifier, ep,
> + struct v4l2_async_subdev);
> + if (IS_ERR(asd)) {
> + fwnode_handle_put(ep);
> + return PTR_ERR(asd);
> + }
> +
> + fwnode_handle_put(ep);
> +
> + tc358746->notifier.ops = &tc358746_notify_ops;
> +
> + err = v4l2_async_subdev_nf_register(&tc358746->sd, &tc358746->notifier);
> + if (err) {
> + v4l2_async_nf_cleanup(&tc358746->notifier);
> + return err;
> + }
> +
> + tc358746->sd.fwnode = fwnode_graph_get_endpoint_by_id(
> + dev_fwnode(tc358746->sd.dev), TC358746_SOURCE, 0, 0);
> +
> + err = v4l2_async_register_subdev(&tc358746->sd);
> + if (err) {
> + v4l2_async_nf_unregister(&tc358746->notifier);
> + v4l2_async_nf_cleanup(&tc358746->notifier);
> + }
> +
> + return err;
> +}
> +
> +static int tc358746_probe(struct i2c_client *client)
> +{
> + struct clk_init_data mclk_initdata = { };
> + struct device *dev = &client->dev;
> + struct v4l2_fwnode_endpoint *vep;
> + unsigned long csi_link_rate;
> + struct tc358746 *tc358746;
> + struct fwnode_handle *ep;
> + unsigned char csi_lanes;
> + struct v4l2_subdev *sd;
> + struct v4l2_ctrl *ctrl;
> + unsigned long refclk;
> + unsigned int i;
> + int err;
> + u32 val;
> +
> + tc358746 = devm_kzalloc(&client->dev, sizeof(*tc358746), GFP_KERNEL);
> + if (!tc358746)
> + return -ENOMEM;
> +
> + tc358746->regmap = devm_regmap_init_i2c(client, &tc358746_regmap_config);
> + if (IS_ERR(tc358746->regmap))
> + return dev_err_probe(dev, PTR_ERR(tc358746->regmap),
> + "Failed to init regmap\n");
> +
> + tc358746->refclk = devm_clk_get(dev, "refclk");
> + if (IS_ERR(tc358746->refclk))
> + return dev_err_probe(dev, PTR_ERR(tc358746->refclk),
> + "Failed to get refclk\n");
> +
> + err = clk_prepare_enable(tc358746->refclk);
> + if (err)
> + return dev_err_probe(dev, err,
> + "Failed to enable refclk\n");
> +
> + refclk = clk_get_rate(tc358746->refclk);
> + clk_disable_unprepare(tc358746->refclk);
> +
> + if (refclk < 6 * MHZ || refclk > 40 * MHZ)
> + return dev_err_probe(dev, -EINVAL, "Invalid refclk range\n");
> +
> + for (i = 0; i < ARRAY_SIZE(tc358746_supplies); i++)
> + tc358746->supplies[i].supply = tc358746_supplies[i];
> +
> + err = devm_regulator_bulk_get(dev, ARRAY_SIZE(tc358746_supplies),
> + tc358746->supplies);
> + if (err)
> + return dev_err_probe(dev, err, "Failed to get supplies\n");
> +
> + tc358746->reset_gpio = devm_gpiod_get_optional(dev, "reset",
> + GPIOD_OUT_HIGH);
> + if (IS_ERR(tc358746->reset_gpio))
> + return dev_err_probe(dev, PTR_ERR(tc358746->reset_gpio),
> + "Failed to get reset-gpios\n");
> +
> + sd = &tc358746->sd;
> + v4l2_i2c_subdev_init(sd, client, &tc358746_ops);
> + sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
> + sd->entity.function = MEDIA_ENT_F_VID_IF_BRIDGE;
> + sd->entity.ops = &tc358746_entity_ops;
> +
> + tc358746->pads[TC358746_SINK].flags = MEDIA_PAD_FL_SINK;
> + tc358746->pads[TC358746_SOURCE].flags = MEDIA_PAD_FL_SOURCE;
> + err = media_entity_pads_init(&sd->entity, TC358746_NR_PADS,
> + tc358746->pads);
> + if (err)
> + return dev_err_probe(dev, err,
> + "Failed to setup media-entity pads\n");
> +
> + ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(dev), TC358746_SOURCE,
> + 0, 0);
> + if (!ep) {
> + dev_err(dev, "Missing endpoint node\n");
> + err = -EINVAL;
> + goto err_mc;
> + }
> +
> + /* Currently we only support 'parallel in' -> 'csi out' */
> + vep = &tc358746->csi_vep;
> + vep->bus_type = V4L2_MBUS_CSI2_DPHY;
> + err = v4l2_fwnode_endpoint_alloc_parse(ep, vep);
> + fwnode_handle_put(ep);
> + if (err) {
> + dev_err(dev, "Failed to parse source endpoint\n");
> + goto err_mc;
> + }
> +
> + csi_lanes = vep->bus.mipi_csi2.num_data_lanes;
> + if (csi_lanes == 0 || csi_lanes > 4 ||
> + vep->nr_of_link_frequencies == 0) {
> + dev_err(dev, "error: Invalid CSI-2 settings\n");
> + err = -EINVAL;
> + goto err_vep;
> + }
> +
> + /* TODO: Add support to handle multiple link frequencies */
> + csi_link_rate = (unsigned long)vep->link_frequencies[0];
> + tc358746->pll_rate = tc358746_find_pll_settings(tc358746, refclk,
> + csi_link_rate * 2);
> + if (!tc358746->pll_rate) {
> + err = -EINVAL;
> + goto err_vep;
> + }
> +
> + err = phy_mipi_dphy_get_default_config_for_hsclk(tc358746->pll_rate,
> + csi_lanes,
> + &tc358746->dphy_cfg);
> + if (err)
> + goto err_vep;
> +
> + tc358746->mbusfmt = tc358746_def_fmt;
> + tc358746->vb_size = TC358746_VB_DEFAULT_SIZE;
> +
> + dev_set_drvdata(dev, tc358746);
> + pm_runtime_set_autosuspend_delay(dev, 200);
> + pm_runtime_use_autosuspend(dev);
> + pm_runtime_enable(dev);
> +
> + err = pm_runtime_resume_and_get(dev);
> + if (err < 0) {
> + dev_err(dev, "Failed to resume the device\n");
> + goto err_vep;
> + }
> +
> + /* Ensure that CSI interface is put into LP-11 state */
> + err = tc358746_sw_reset(tc358746);
> + if (err) {
> + pm_runtime_put_noidle(dev);
> + dev_err(dev, "Failed to reset the device\n");
> + goto err_pm;
> + }
> +
> + err = tc358746_read(tc358746, CHIPID_REG, &val);
> + pm_runtime_mark_last_busy(dev);
> + pm_runtime_put_sync_autosuspend(dev);
> + if (err) {
> + dev_err(dev, "Failed to read chipid\n");
> + err = -ENODEV;
> + goto err_pm;
> + }
> +
> + if (FIELD_GET(CHIPID, val) != 0x44) {
> + dev_err(dev, "Invalid chipid 0x%02x\n",
> + (u32)FIELD_GET(CHIPID, val));
> + err = -ENODEV;
> + goto err_pm;
> + }
> +
> + /* Optional MCLK provider support */
> + if (device_property_present(dev, "#clock-cells")) {
> + const char *mclk_name;
> +
> + /* Init to highest possibel MCLK */
> + tc358746->mclk_postdiv = 512;
> + tc358746->mclk_prediv = 8;
> +
> + mclk_name = "tc358746-mclk";
> + device_property_read_string(dev, "clock-output-names",
> + &mclk_name);
> +
> + mclk_initdata.name = mclk_name;
> + mclk_initdata.ops = &tc358746_mclk_ops;
> + tc358746->mclk_hw.init = &mclk_initdata;
> +
> + err = devm_clk_hw_register(dev, &tc358746->mclk_hw);
> + if (err) {
> + dev_err(dev, "Failed to register mclk provider\n");
> + goto err_pm;
> + }
> +
> + err = devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get,
> + &tc358746->mclk_hw);
> + if (err) {
> + dev_err(dev, "Failed to add mclk provider\n");
> + goto err_pm;
> + }
> + }
> +
> + v4l2_ctrl_handler_init(&tc358746->ctrl_hdl, 1);
> +
> + ctrl = v4l2_ctrl_new_int_menu(&tc358746->ctrl_hdl, NULL,
> + V4L2_CID_LINK_FREQ, 0, 0,
> + vep->link_frequencies);
> + if (ctrl)
> + ctrl->flags |= V4L2_CTRL_FLAG_READ_ONLY;
> +
> + tc358746->sd.ctrl_handler = &tc358746->ctrl_hdl;
> + if (tc358746->ctrl_hdl.error) {
> + err = tc358746->ctrl_hdl.error;
> + goto err_pm;
> + }
> +
> + v4l2_ctrl_handler_setup(&tc358746->ctrl_hdl);
> +
> + err = tc358746_async_register(tc358746);
> + if (err < 0)
> + goto err_ctrl;
> +
> + dev_info(dev, "%s found @ 0x%x (%s)\n", client->name,
> + client->addr, client->adapter->name);
I'd skip this to avoid adding noise to the kernel log at boot time. I
would also probably split some of the code out of the probe function as
it's fairly large. Up to you.
> +
> + return 0;
> +
> +err_ctrl:
> + v4l2_ctrl_handler_free(&tc358746->ctrl_hdl);
> +err_pm:
> + pm_runtime_disable(dev);
> + pm_runtime_set_suspended(dev);
> + pm_runtime_dont_use_autosuspend(dev);
> +err_vep:
> + v4l2_fwnode_endpoint_free(vep);
> +err_mc:
> + media_entity_cleanup(&sd->entity);
> +
> + return err;
> +}
> +
> +static int tc358746_remove(struct i2c_client *client)
> +{
> + struct v4l2_subdev *sd = i2c_get_clientdata(client);
> + struct tc358746 *tc358746 = to_tc358746(sd);
> +
> + v4l2_ctrl_handler_free(&tc358746->ctrl_hdl);
> + v4l2_fwnode_endpoint_free(&tc358746->csi_vep);
> + v4l2_async_nf_unregister(&tc358746->notifier);
> + v4l2_async_nf_cleanup(&tc358746->notifier);
> + v4l2_async_unregister_subdev(sd);
> + v4l2_device_unregister_subdev(sd);
This shouldn't be needed v4l2_async_unregister_subdev() should be
enough.
> + media_entity_cleanup(&sd->entity);
> +
> + pm_runtime_disable(sd->dev);
> + pm_runtime_set_suspended(sd->dev);
> + pm_runtime_dont_use_autosuspend(sd->dev);
> +
> + return 0;
> +}
> +
> +static int tc358746_suspend(struct device *dev)
> +{
> + struct tc358746 *tc358746 = dev_get_drvdata(dev);
> +
> + clk_disable_unprepare(tc358746->refclk);
> +
> + return regulator_bulk_disable(ARRAY_SIZE(tc358746_supplies),
> + tc358746->supplies);
Shouldn't you reenable the clock if this fails ?
> +}
> +
> +static int tc358746_resume(struct device *dev)
> +{
> + struct tc358746 *tc358746 = dev_get_drvdata(dev);
> + int err;
> +
> + gpiod_set_value(tc358746->reset_gpio, 1);
> +
> + err = regulator_bulk_enable(ARRAY_SIZE(tc358746_supplies),
> + tc358746->supplies);
> + if (err)
> + return err;
> +
> + /* min. 200ns */
> + usleep_range(10, 20);
> +
> + gpiod_set_value(tc358746->reset_gpio, 0);
> +
> + err = clk_prepare_enable(tc358746->refclk);
> + if (err)
> + return err;
The regulators need to be disabled in case of failure here and below
(and so does the clock below).
> +
> + /* min. 700us ... 1ms */
> + usleep_range(1000, 1500);
> +
> + /* Sync state */
> + err = tc358746_apply_pll_config(tc358746);
> + if (err)
> + return err;
> +
> + err = tc358746_apply_dphy_config(tc358746);
> + if (err)
> + return err;
> +
> + return tc358746_apply_misc_config(tc358746);
Does all this belong to the PM resume handler ? It seems configuration
could be handled in .s_stream() instead.
> +}
> +
> +DEFINE_RUNTIME_DEV_PM_OPS(tc358746_pm_ops, tc358746_suspend,
> + tc358746_resume, NULL);
> +
> +static const struct of_device_id __maybe_unused tc358746_of_match[] = {
> + { .compatible = "toshiba,tc358746" },
> + { },
> +};
> +MODULE_DEVICE_TABLE(of, tc358746_of_match);
> +
> +static struct i2c_driver tc358746_driver = {
> + .driver = {
> + .name = "tc358746",
> + .pm = pm_ptr(&tc358746_pm_ops),
> + .of_match_table = tc358746_of_match,
> + },
> + .probe_new = tc358746_probe,
> + .remove = tc358746_remove,
> +};
> +
> +module_i2c_driver(tc358746_driver);
> +
> +MODULE_DESCRIPTION("Toshiba TC358746 Parallel to CSI-2 bridge driver");
> +MODULE_AUTHOR("Marco Felsch <kernel@pengutronix.de>");
> +MODULE_LICENSE("GPL");
--
Regards,
Laurent Pinchart
^ permalink raw reply [flat|nested] 34+ messages in thread
* Re: [PATCH 4/4] media: tc358746: add Toshiba TC358746 Parallel to CSI-2 bridge driver
@ 2022-09-05 20:03 ` Laurent Pinchart
0 siblings, 0 replies; 34+ messages in thread
From: Laurent Pinchart @ 2022-09-05 20:03 UTC (permalink / raw)
To: Marco Felsch
Cc: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, linux-kernel, linux-phy,
devicetree, linux-media, kernel
Hi Marco,
Thank you for the patch.
On Thu, Aug 18, 2022 at 04:33:07PM +0200, Marco Felsch wrote:
> Adding support for the TC358746 parallel <-> MIPI CSI bridge. This chip
> supports two operating modes:
> 1st) parallel-in -> mipi-csi out
> 2nd) mipi-csi in -> parallel out
>
> This patch only adds the support for the 1st mode.
>
> Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
> ---
> drivers/media/i2c/Kconfig | 17 +
> drivers/media/i2c/Makefile | 1 +
> drivers/media/i2c/tc358746.c | 1645 ++++++++++++++++++++++++++++++++++
> 3 files changed, 1663 insertions(+)
> create mode 100644 drivers/media/i2c/tc358746.c
>
> diff --git a/drivers/media/i2c/Kconfig b/drivers/media/i2c/Kconfig
> index 7806d4b81716..aefb9c9e0c08 100644
> --- a/drivers/media/i2c/Kconfig
> +++ b/drivers/media/i2c/Kconfig
> @@ -1272,6 +1272,23 @@ config VIDEO_TC358743_CEC
> When selected the tc358743 will support the optional
> HDMI CEC feature.
>
> +config VIDEO_TC358746
> + tristate "Toshiba TC358746 parallel-CSI2 bridge"
> + depends on VIDEO_DEV && I2C
> + select VIDEO_V4L2_SUBDEV_API
> + select MEDIA_CONTROLLER
> + select V4L2_FWNODE
> + select GENERIC_PHY_MIPI_DPHY
> + select REGMAP_I2C
> + select COMMON_CLK
> + help
> + Support for the Toshiba TC358746 parallel to MIPI CSI-2 bridge.
> + The bridge can work in both directions but currently only the
> + parallel-in / csi-out path is supported.
> +
> + To compile this driver as a module, choose M here: the
> + module will be called tc358746.
> +
> config VIDEO_TVP514X
> tristate "Texas Instruments TVP514x video decoder"
> depends on VIDEO_DEV && I2C
> diff --git a/drivers/media/i2c/Makefile b/drivers/media/i2c/Makefile
> index 0a2933103dd9..d1096c2ab480 100644
> --- a/drivers/media/i2c/Makefile
> +++ b/drivers/media/i2c/Makefile
> @@ -118,6 +118,7 @@ obj-$(CONFIG_VIDEO_SONY_BTF_MPX) += sony-btf-mpx.o
> obj-$(CONFIG_VIDEO_SR030PC30) += sr030pc30.o
> obj-$(CONFIG_VIDEO_ST_MIPID02) += st-mipid02.o
> obj-$(CONFIG_VIDEO_TC358743) += tc358743.o
> +obj-$(CONFIG_VIDEO_TC358746) += tc358746.o
> obj-$(CONFIG_VIDEO_TDA1997X) += tda1997x.o
> obj-$(CONFIG_VIDEO_TDA7432) += tda7432.o
> obj-$(CONFIG_VIDEO_TDA9840) += tda9840.o
> diff --git a/drivers/media/i2c/tc358746.c b/drivers/media/i2c/tc358746.c
> new file mode 100644
> index 000000000000..7b71d0cf72a9
> --- /dev/null
> +++ b/drivers/media/i2c/tc358746.c
> @@ -0,0 +1,1645 @@
> +// SPDX-License-Identifier: GPL-2.0-only
> +/*
> + * TC358746 - Parallel <-> CSI-2 Bridge
> + *
> + * Copyright 2022 Marco Felsch <kernel@pengutronix.de>
> + *
> + * Notes:
> + * - Currently only 'Parallel-in -> CSI-out' mode is supported!
> + */
> +
> +#include <linux/bitfield.h>
> +#include <linux/clk.h>
> +#include <linux/clk-provider.h>
> +#include <linux/delay.h>
> +#include <linux/i2c.h>
> +#include <linux/interrupt.h>
> +#include <linux/kernel.h>
> +#include <linux/module.h>
> +#include <linux/phy/phy-mipi-dphy.h>
> +#include <linux/property.h>
> +#include <linux/pm_runtime.h>
> +#include <linux/regmap.h>
> +#include <media/v4l2-ctrls.h>
> +#include <media/v4l2-device.h>
> +#include <media/v4l2-fwnode.h>
> +#include <media/v4l2-mc.h>
> +
> +/* 16-bit registers */
> +#define CHIPID_REG 0x0000
> +#define CHIPID GENMASK(15, 8)
> +
> +#define SYSCTL_REG 0x0002
> +#define SRESET BIT(0)
> +
> +#define CONFCTL_REG 0x0004
> +#define PDATAF_MASK GENMASK(9, 8)
> +#define PDATAF_MODE0 0
> +#define PDATAF_MODE1 1
> +#define PDATAF_MODE2 2
> +#define PDATAF(val) FIELD_PREP(PDATAF_MASK, (val))
> +#define PPEN BIT(6)
> +#define DATALANE_MASK GENMASK(1, 0)
> +
> +#define FIFOCTL_REG 0x0006
> +#define DATAFMT_REG 0x0008
> +#define PDFMT(val) FIELD_PREP(GENMASK(7, 4), (val))
> +
> +#define MCLKCTL_REG 0x000c
> +#define MCLK_HIGH_MASK GENMASK(15, 8)
> +#define MCLK_LOW_MASK GENMASK(7, 0)
> +#define MCLK_HIGH(val) FIELD_PREP(MCLK_HIGH_MASK, (val))
> +#define MCLK_LOW(val) FIELD_PREP(MCLK_LOW_MASK, (val))
> +
> +#define PLLCTL0_REG 0x0016
> +#define PLL_PRD_MASK GENMASK(15, 12)
> +#define PLL_PRD(val) FIELD_PREP(PLL_PRD_MASK, (val))
> +#define PLL_FBD_MASK GENMASK(8, 0)
> +#define PLL_FBD(val) FIELD_PREP(PLL_FBD_MASK, (val))
> +
> +#define PLLCTL1_REG 0x0018
> +#define PLL_FRS_MASK GENMASK(11, 10)
> +#define PLL_FRS(val) FIELD_PREP(PLL_FRS_MASK, (val))
> +#define CKEN BIT(4)
> +#define RESETB BIT(1)
> +#define PLL_EN BIT(0)
> +
> +#define CLKCTL_REG 0x0020
> +#define MCLKDIV_MASK GENMASK(3, 2)
> +#define MCLKDIV(val) FIELD_PREP(MCLKDIV_MASK, (val))
> +#define MCLKDIV_8 0
> +#define MCLKDIV_4 1
> +#define MCLKDIV_2 2
> +
> +#define WORDCNT_REG 0x0022
> +#define PP_MISC_REG 0x0032
> +#define FRMSTOP BIT(15)
> +#define RSTPTR BIT(14)
> +
> +/* 32-bit registers */
> +#define CLW_DPHYCONTTX_REG 0x0100
> +#define CLW_CNTRL_REG 0x0140
> +#define D0W_CNTRL_REG 0x0144
> +#define LANEDISABLE BIT(0)
> +
> +#define STARTCNTRL_REG 0x0204
> +#define START BIT(0)
> +
> +#define LINEINITCNT_REG 0x0210
> +#define LPTXTIMECNT_REG 0x0214
> +#define TCLK_HEADERCNT_REG 0x0218
> +#define TCLK_ZEROCNT(val) FIELD_PREP(GENMASK(15, 8), (val))
> +#define TCLK_PREPARECNT(val) FIELD_PREP(GENMASK(6, 0), (val))
> +
> +#define TCLK_TRAILCNT_REG 0x021C
> +#define THS_HEADERCNT_REG 0x0220
> +#define THS_ZEROCNT(val) FIELD_PREP(GENMASK(14, 8), (val))
> +#define THS_PREPARECNT(val) FIELD_PREP(GENMASK(6, 0), (val))
> +
> +#define TWAKEUP_REG 0x0224
> +#define TCLK_POSTCNT_REG 0x0228
> +#define THS_TRAILCNT_REG 0x022C
> +#define HSTXVREGEN_REG 0x0234
> +#define TXOPTIONCNTRL_REG 0x0238
> +#define CSI_CONTROL_REG 0x040C
> +#define CSI_MODE BIT(15)
> +#define TXHSMD BIT(7)
> +#define NOL(val) FIELD_PREP(GENMASK(2, 1), (val))
> +
> +#define CSI_CONFW_REG 0x0500
> +#define MODE(val) FIELD_PREP(GENMASK(31, 29), (val))
> +#define MODE_SET 0x5
> +#define ADDRESS(val) FIELD_PREP(GENMASK(28, 24), (val))
> +#define CSI_CONTROL_ADDRESS 0x3
> +#define DATA(val) FIELD_PREP(GENMASK(15, 0), (val))
> +
> +#define CSI_START_REG 0x0518
> +#define STRT BIT(0)
> +
> +static const struct v4l2_mbus_framefmt tc358746_def_fmt = {
> + .width = 640,
> + .height = 480,
> + .code = MEDIA_BUS_FMT_UYVY8_2X8,
> + .field = V4L2_FIELD_NONE,
> + .colorspace = V4L2_COLORSPACE_DEFAULT,
> + .ycbcr_enc = V4L2_YCBCR_ENC_DEFAULT,
> + .quantization = V4L2_QUANTIZATION_DEFAULT,
> + .xfer_func = V4L2_XFER_FUNC_DEFAULT,
> +};
> +
> +static const char * const tc358746_supplies[] = {
> + "vddc", "vddio", "vddmipi"
> +};
> +
> +enum {
> + TC358746_SINK,
> + TC358746_SOURCE,
> + TC358746_NR_PADS
> +};
> +
> +struct tc358746 {
> + struct v4l2_subdev sd;
> + struct media_pad pads[TC358746_NR_PADS];
> + struct v4l2_async_notifier notifier;
> + struct v4l2_mbus_framefmt mbusfmt;
Could you use the active state API instead of manually storing mbusfmt
here ? It involves
- Implementing the .init_cfg() operation
- Calling v4l2_subdev_init_finalize() in probe
- Replacing calls to __tc358746_get_pad_format() with
v4l2_subdev_get_pad_format()
- Propagating the format from sink to source in tc358746_set_fmt()
- Dropping tc358746_src_mbus_code() from tc358746_get_fmt() and simply
retrieving the format using v4l2_subdev_get_pad_format() there
- Dropping this field
The formats for both the ACTIVE and TRY states will then be stored in
the subdev state, unconditionally. You can retrieve the active state
with v4l2_subdev_get_locked_active_state() in tc358746_s_stream().
> + struct v4l2_fwnode_endpoint csi_vep;
> +
> + struct v4l2_ctrl_handler ctrl_hdl;
> +
> + struct regmap *regmap;
> + struct clk *refclk;
> + struct gpio_desc *reset_gpio;
> + struct regulator_bulk_data supplies[ARRAY_SIZE(tc358746_supplies)];
> +
> + struct clk_hw mclk_hw;
> + unsigned long mclk_rate;
> + u8 mclk_prediv;
> + u16 mclk_postdiv;
> +
> + unsigned long pll_rate;
> + u8 pll_post_div;
> + u16 pll_pre_div;
> + u16 pll_mul;
> +
> + struct v4l2_ctrl *sensor_pclk_ctrl;
> +
> +#define TC358746_VB_MAX_SIZE (511 * 32)
> +#define TC358746_VB_DEFAULT_SIZE (1 * 32)
> + unsigned int vb_size; /* Video buffer size in bits */
> +
> + struct phy_configure_opts_mipi_dphy dphy_cfg;
> +};
> +
> +static inline struct tc358746 *to_tc358746(struct v4l2_subdev *sd)
> +{
> + return container_of(sd, struct tc358746, sd);
> +}
> +
> +static inline struct tc358746 *clk_hw_to_tc358746(struct clk_hw *hw)
> +{
> + return container_of(hw, struct tc358746, mclk_hw);
> +}
> +
> +struct tc358746_format {
> + u32 code;
> + bool csi_format;
> + unsigned char bus_width;
> + unsigned char bpp;
> + /* Register values */
> + u8 pdformat; /* Peripheral Data Format */
> + u8 pdataf; /* Parallel Data Format Option */
> +};
> +
> +enum {
> + PDFORMAT_RAW8 = 0,
> + PDFORMAT_RAW10,
> + PDFORMAT_RAW12,
> + PDFORMAT_RGB888,
> + PDFORMAT_RGB666,
> + PDFORMAT_RGB565,
> + PDFORMAT_YUV422_8BIT,
> + /* RESERVED = 7 */
> + PDFORMAT_RAW14 = 8,
> + PDFORMAT_YUV422_10BIT,
> + PDFORMAT_YUV444,
> +};
> +
> +/* Check tc358746_src_mbus_code() if you add new formats */
> +static const struct tc358746_format tc358746_formats[] = {
> + {
> + .code = MEDIA_BUS_FMT_UYVY8_2X8,
> + .bus_width = 8,
> + .bpp = 16,
> + .pdformat = PDFORMAT_YUV422_8BIT,
> + .pdataf = PDATAF_MODE0,
> + }, {
> + .code = MEDIA_BUS_FMT_UYVY8_1X16,
> + .csi_format = true,
> + .bus_width = 16,
> + .bpp = 16,
> + .pdformat = PDFORMAT_YUV422_8BIT,
> + .pdataf = PDATAF_MODE1,
> + }, {
> + .code = MEDIA_BUS_FMT_YUYV8_1X16,
> + .csi_format = true,
> + .bus_width = 16,
> + .bpp = 16,
> + .pdformat = PDFORMAT_YUV422_8BIT,
> + .pdataf = PDATAF_MODE2,
> + }, {
> + .code = MEDIA_BUS_FMT_UYVY10_2X10,
> + .bus_width = 10,
> + .bpp = 20,
> + .pdformat = PDFORMAT_YUV422_10BIT,
> + .pdataf = PDATAF_MODE0, /* don't care */
> + }, {
> + /* in datasheet listed as YUV444 */
> + .code = MEDIA_BUS_FMT_GBR888_1X24,
> + .csi_format = true,
> + .bus_width = 24,
> + .bpp = 24,
> + .pdformat = PDFORMAT_YUV444,
This looks quite weird, does 24-bit RGB really map to the CSI-2 YUV444
data type ?
> + .pdataf = PDATAF_MODE0, /* don't care */
> + },
> +};
> +
> +/* Get n-th format for pad */
> +static const struct tc358746_format *
> +tc358746_get_format_by_idx(unsigned int pad, unsigned int index)
> +{
> + unsigned int idx = 0;
> + unsigned int i;
> +
> + if (pad >= TC358746_NR_PADS)
> + return ERR_PTR(-EINVAL);
That should be tested by the subdev core, I think you can drop the
check. Same below.
> +
> + for (i = 0; i < ARRAY_SIZE(tc358746_formats); i++) {
> + const struct tc358746_format *fmt = &tc358746_formats[i];
> +
> + if ((pad == TC358746_SOURCE && fmt->csi_format) ||
> + (pad == TC358746_SINK)) {
> + if (idx == index)
> + return fmt;
> + idx++;
> + }
> + }
> +
> + return ERR_PTR(-EINVAL);
> +}
> +
> +static const struct tc358746_format *
> +tc358746_get_format_by_code(unsigned int pad, u32 code)
> +{
> + unsigned int i;
> +
> + if (pad >= TC358746_NR_PADS)
> + return ERR_PTR(-EINVAL);
> +
> + for (i = 0; i < ARRAY_SIZE(tc358746_formats); i++) {
> + const struct tc358746_format *fmt = &tc358746_formats[i];
> +
> + if (pad == TC358746_SINK && fmt->code == code)
> + return fmt;
> +
> + if (pad == TC358746_SOURCE && fmt->csi_format &&
> + fmt->code == code)
> + return fmt;
You could also write
if (pad == TC358746_SOURCE && !fmt->csi_format)
continue;
if (fmt->code == code)
return fmt;
Up to you.
> + }
> +
> + return ERR_PTR(-EINVAL);
> +}
> +
> +static u32 tc358746_src_mbus_code(u32 code)
> +{
> + switch (code) {
> + case MEDIA_BUS_FMT_UYVY8_2X8:
> + return MEDIA_BUS_FMT_UYVY8_1X16;
> + case MEDIA_BUS_FMT_UYVY10_2X10:
> + return MEDIA_BUS_FMT_UYVY10_1X20;
> + default:
> + return code;
> + }
> +}
> +
> +static bool tc358746_writeable_reg(struct device *dev, unsigned int reg)
> +{
> + switch (reg) {
> + case SYSCTL_REG ... CSI_START_REG:
> + return true;
> + default:
> + return false;
> + }
> +}
> +
> +static bool tc358746_readable_reg(struct device *dev, unsigned int reg)
> +{
> + switch (reg) {
> + case CHIPID_REG ... CSI_START_REG:
> + return true;
> + default:
> + return false;
> + }
> +}
> +
> +static const struct regmap_config tc358746_regmap_config = {
> + .name = "tc358746",
> + .reg_bits = 16,
> + .val_bits = 16,
> + .max_register = CSI_START_REG,
> + .writeable_reg = tc358746_writeable_reg,
> + .readable_reg = tc358746_readable_reg,
> + .reg_format_endian = REGMAP_ENDIAN_BIG,
> + .val_format_endian = REGMAP_ENDIAN_BIG,
> +};
> +
> +static int tc358746_write(struct tc358746 *tc358746, u32 reg, u32 val)
> +{
> + size_t count;
> +
> + /* 32-bit registers starting from CLW_DPHYCONTTX */
> + count = reg < CLW_DPHYCONTTX_REG ? 1 : 2;
> +
> + return regmap_bulk_write(tc358746->regmap, reg, &val, count);
> +}
> +
> +static int tc358746_read(struct tc358746 *tc358746, u32 reg, u32 *val)
> +{
> + size_t count;
> +
> + /* 32-bit registers starting from CLW_DPHYCONTTX */
> + count = reg < CLW_DPHYCONTTX_REG ? 1 : 2;
> + *val = 0;
> +
> + return regmap_bulk_read(tc358746->regmap, reg, val, count);
> +}
> +
> +static int
> +tc358746_update_bits(struct tc358746 *tc358746, u32 reg, u32 mask, u32 val)
> +{
> + u32 tmp, orig;
> + int err;
> +
> + err = tc358746_read(tc358746, reg, &orig);
> + if (err)
> + return err;
> +
> + tmp = orig & ~mask;
> + tmp |= val & mask;
> +
> + return tc358746_write(tc358746, reg, tmp);
> +}
> +
> +static int tc358746_set_bits(struct tc358746 *tc358746, u32 reg, u32 bits)
> +{
> + return tc358746_update_bits(tc358746, reg, bits, bits);
> +}
> +
> +static int tc358746_clear_bits(struct tc358746 *tc358746, u32 reg, u32 bits)
> +{
> + return tc358746_update_bits(tc358746, reg, bits, 0);
> +}
> +
> +static int tc358746_sw_reset(struct tc358746 *tc358746)
> +{
> + int err;
> +
> + err = tc358746_set_bits(tc358746, SYSCTL_REG, SRESET);
> + if (err)
> + return err;
> +
> + udelay(10);
> +
> + return tc358746_clear_bits(tc358746, SYSCTL_REG, SRESET);
> +}
> +
> +static int
> +tc358746_apply_pll_config(struct tc358746 *tc358746)
> +{
> + u8 post = tc358746->pll_post_div;
> + u16 pre = tc358746->pll_pre_div;
> + u16 mul = tc358746->pll_mul;
> + u32 val, mask;
> + int err;
> +
> + err = tc358746_read(tc358746, PLLCTL1_REG, &val);
> + if (err)
> + return err;
> +
> + /* Don't touch the PLL if running */
> + if (FIELD_GET(PLL_EN, val) == 1)
> + return 0;
> +
> + /* Pre-div and Multiplicator have a internal +1 logic */
> + val = PLL_PRD(pre - 1) | PLL_FBD(mul - 1);
> + mask = PLL_PRD_MASK | PLL_FBD_MASK;
> + err = tc358746_update_bits(tc358746, PLLCTL0_REG, mask, val);
> + if (err)
> + return err;
> +
> + val = PLL_FRS(ilog2(post)) | RESETB | PLL_EN;
> + mask = PLL_FRS_MASK | RESETB | PLL_EN;
> + tc358746_update_bits(tc358746, PLLCTL1_REG, mask, val);
> + if (err)
> + return err;
> +
> + udelay(1000);
> +
> + return tc358746_set_bits(tc358746, PLLCTL1_REG, CKEN);
> +}
> +
> +static int tc358746_apply_misc_config(struct tc358746 *tc358746)
> +{
> + struct device *dev = tc358746->sd.dev;
> + const struct tc358746_format *fmt;
> + u32 val;
> + int err;
> +
> + fmt = tc358746_get_format_by_code(TC358746_SINK, tc358746->mbusfmt.code);
> + if (IS_ERR(fmt))
> + return PTR_ERR(fmt);
mbusfmt.code is supposed to have been validated, so you can drop the
error check here.
> +
> + /* Self defined CSI user data type id's are not supported yet */
> + val = PDFMT(fmt->pdformat);
> + dev_dbg(dev, "DATAFMT: 0x%x\n", val);
> + err = tc358746_write(tc358746, DATAFMT_REG, val);
> + if (err)
> + return err;
> +
> + val = PDATAF(fmt->pdataf);
> + dev_dbg(dev, "CONFCTL[PDATAF]: 0x%x\n", fmt->pdataf);
> + err = tc358746_update_bits(tc358746, CONFCTL_REG, PDATAF_MASK, val);
> + if (err)
> + return err;
> +
> + val = tc358746->vb_size / 32;
> + dev_dbg(dev, "FIFOCTL: %u (0x%x)\n", val, val);
> + err = tc358746_write(tc358746, FIFOCTL_REG, val);
> + if (err)
> + return err;
> +
> + /* Total number of bytes for each line/width */
> + val = tc358746->mbusfmt.width * fmt->bpp / 8;
> + dev_dbg(dev, "WORDCNT: %u (0x%x)\n", val, val);
> + return tc358746_write(tc358746, WORDCNT_REG, val);
> +}
> +
> +#ifndef MHZ
Where would it be previously defined ? This sounds like asking for
trouble later.
> +#define MHZ (1000 * 1000)
> +#endif
> +
> +/* Use MHz as base so the div needs no u64 */
> +static u32 tc358746_cfg_to_cnt(unsigned int cfg_val,
> + unsigned int clk_mhz,
> + unsigned int time_base)
> +{
> + return DIV_ROUND_UP(cfg_val * clk_mhz, time_base);
> +}
> +
> +static u32 tc358746_ps_to_cnt(unsigned int cfg_val,
> + unsigned int clk_mhz)
> +{
> + return tc358746_cfg_to_cnt(cfg_val, clk_mhz, USEC_PER_SEC);
> +}
> +
> +static u32 tc358746_us_to_cnt(unsigned int cfg_val,
> + unsigned int clk_mhz)
> +{
> + return tc358746_cfg_to_cnt(cfg_val, clk_mhz, 1);
> +}
> +
> +static int tc358746_apply_dphy_config(struct tc358746 *tc358746)
> +{
> + struct phy_configure_opts_mipi_dphy *cfg = &tc358746->dphy_cfg;
> + bool non_cont_clk = !!(tc358746->csi_vep.bus.mipi_csi2.flags &
> + V4L2_MBUS_CSI2_NONCONTINUOUS_CLOCK);
> + struct device *dev = tc358746->sd.dev;
> + unsigned long hs_byte_clk, hf_clk;
> + u32 val, val2, lptxcnt;
> + int err;
> +
> + /* The hs_byte_clk is also called SYSCLK in the excel sheet */
> + hs_byte_clk = cfg->hs_clk_rate / 8;
> + hs_byte_clk /= MHZ;
> + hf_clk = hs_byte_clk / 2;
> +
> + val = tc358746_us_to_cnt(cfg->init, hf_clk) - 1;
> + dev_dbg(dev, "LINEINITCNT: %u (0x%x)\n", val, val);
> + err = tc358746_write(tc358746, LINEINITCNT_REG, val);
> + if (err)
> + return err;
> +
> + val = tc358746_ps_to_cnt(cfg->lpx, hs_byte_clk) - 1;
> + lptxcnt = val;
> + dev_dbg(dev, "LPTXTIMECNT: %u (0x%x)\n", val, val);
> + err = tc358746_write(tc358746, LPTXTIMECNT_REG, val);
> + if (err)
> + return err;
> +
> + val = tc358746_ps_to_cnt(cfg->clk_prepare, hs_byte_clk) - 1;
> + val2 = tc358746_ps_to_cnt(cfg->clk_zero, hs_byte_clk) - 1;
> + dev_dbg(dev, "TCLK_PREPARECNT: %u (0x%x)\n", val, val);
> + dev_dbg(dev, "TCLK_ZEROCNT: %u (0x%x)\n", val2, val2);
> + dev_dbg(dev, "TCLK_HEADERCNT: 0x%x\n",
> + (u32)(TCLK_PREPARECNT(val) | TCLK_ZEROCNT(val2)));
> + err = tc358746_write(tc358746, TCLK_HEADERCNT_REG,
> + TCLK_PREPARECNT(val) | TCLK_ZEROCNT(val2));
> + if (err)
> + return err;
> +
> + val = tc358746_ps_to_cnt(cfg->clk_trail, hs_byte_clk);
> + dev_dbg(dev, "TCLK_TRAILCNT: %u (0x%x)\n", val, val);
> + err = tc358746_write(tc358746, TCLK_TRAILCNT_REG, val);
> + if (err)
> + return err;
> +
> + val = tc358746_ps_to_cnt(cfg->hs_prepare, hs_byte_clk) - 1;
> + val2 = tc358746_ps_to_cnt(cfg->hs_zero, hs_byte_clk) - 1;
> + dev_dbg(dev, "THS_PREPARECNT: %u (0x%x)\n", val, val);
> + dev_dbg(dev, "THS_ZEROCNT: %u (0x%x)\n", val2, val2);
> + dev_dbg(dev, "THS_HEADERCNT: 0x%x\n",
> + (u32)(THS_PREPARECNT(val) | THS_ZEROCNT(val2)));
> + err = tc358746_write(tc358746, THS_HEADERCNT_REG,
> + THS_PREPARECNT(val) | THS_ZEROCNT(val2));
> + if (err)
> + return err;
> +
> + /* TWAKEUP > 1ms in lptxcnt steps */
> + val = tc358746_us_to_cnt(cfg->wakeup, hs_byte_clk);
> + val = val / (lptxcnt + 1) - 1;
> + dev_dbg(dev, "TWAKEUP: %u (0x%x)\n", val, val);
> + err = tc358746_write(tc358746, TWAKEUP_REG, val);
> + if (err)
> + return err;
> +
> + val = tc358746_ps_to_cnt(cfg->clk_post, hs_byte_clk);
> + dev_dbg(dev, "TCLK_POSTCNT: %u (0x%x)\n", val, val);
> + err = tc358746_write(tc358746, TCLK_POSTCNT_REG, val);
> + if (err)
> + return err;
> +
> + val = tc358746_ps_to_cnt(cfg->hs_trail, hs_byte_clk);
> + dev_dbg(dev, "THS_TRAILCNT: %u (0x%x)\n", val, val);
> + err = tc358746_write(tc358746, THS_TRAILCNT_REG, val);
> + if (err)
> + return err;
> +
> + dev_dbg(dev, "CONTCLKMODE: %u", non_cont_clk ? 0 : 1);
> + return tc358746_write(tc358746, TXOPTIONCNTRL_REG, non_cont_clk ? 0 : 1);
> +}
> +
> +#define MAX_DATA_LANES 4
> +
> +static int tc358746_enable_csi_lanes(struct tc358746 *tc358746, int enable)
> +{
> + unsigned int lanes = tc358746->dphy_cfg.lanes;
> + unsigned int lane;
> + u32 reg, val;
> + int err;
> +
> + err = tc358746_update_bits(tc358746, CONFCTL_REG, DATALANE_MASK,
> + lanes - 1);
> + if (err)
> + return err;
> +
> + /* Clock lane */
> + val = enable ? 0 : LANEDISABLE;
> + dev_dbg(tc358746->sd.dev, "CLW_CNTRL: 0x%x\n", val);
> + err = tc358746_write(tc358746, CLW_CNTRL_REG, val);
> + if (err)
> + return err;
> +
> + for (lane = 0; lane < MAX_DATA_LANES; lane++) {
> + /* Data lanes */
> + reg = D0W_CNTRL_REG + lane * 0x4;
> + val = (enable && lane < lanes) ? 0 : LANEDISABLE;
> +
> + dev_dbg(tc358746->sd.dev, "D%uW_CNTRL: 0x%x\n", lane, val);
> + err = tc358746_write(tc358746, reg, val);
> + if (err)
> + return err;
> + }
> +
> + val = 0;
> + if (enable) {
> + /* Clock lane */
> + val |= BIT(0);
> +
> + /* Data lanes */
> + for (lane = 1; lane <= lanes; lane++)
> + val |= BIT(lane);
> + }
> +
> + dev_dbg(tc358746->sd.dev, "HSTXVREGEN: 0x%x\n", val);
> + return tc358746_write(tc358746, HSTXVREGEN_REG, val);
> +}
> +
> +static int tc358746_enable_csi_module(struct tc358746 *tc358746, int enable)
> +{
> + unsigned int lanes = tc358746->dphy_cfg.lanes;
> + int err;
> +
> + /*
> + * START and STRT are only reseted/disabled by sw reset. This is
> + * required to put the lane state back into LP-11 state. The sw reset
> + * don't reset register values.
> + */
> + if (!enable)
> + return tc358746_sw_reset(tc358746);
> +
> + err = tc358746_write(tc358746, STARTCNTRL_REG, START);
> + if (err)
> + return err;
> +
> + err = tc358746_write(tc358746, CSI_START_REG, STRT);
> + if (err)
> + return err;
> +
> + /* CSI_CONTROL_REG is only indirect accessible */
> + return tc358746_write(tc358746, CSI_CONFW_REG,
> + MODE(MODE_SET) |
> + ADDRESS(CSI_CONTROL_ADDRESS) |
> + DATA(CSI_MODE | TXHSMD | NOL(lanes - 1)));
> +}
> +
> +static int tc358746_enable_parallel_port(struct tc358746 *tc358746, int enable)
> +{
> + int err;
> +
> + if (enable) {
> + err = tc358746_write(tc358746, PP_MISC_REG, 0);
> + if (err)
> + return err;
> +
> + return tc358746_set_bits(tc358746, CONFCTL_REG, PPEN);
> + }
> +
> + err = tc358746_set_bits(tc358746, PP_MISC_REG, FRMSTOP);
> + if (err)
> + return err;
> +
> + err = tc358746_clear_bits(tc358746, CONFCTL_REG, PPEN);
> + if (err)
> + return err;
> +
> + return tc358746_set_bits(tc358746, PP_MISC_REG, RSTPTR);
> +}
> +
> +static inline struct v4l2_subdev *tc358746_get_remote_sd(struct media_pad *pad)
> +{
> + pad = media_pad_remote_pad_first(pad);
> + if (!pad)
> + return NULL;
> +
> + return media_entity_to_v4l2_subdev(pad->entity);
> +}
> +
> +static int tc358746_s_stream(struct v4l2_subdev *sd, int enable)
> +{
> + struct tc358746 *tc358746 = to_tc358746(sd);
> + struct v4l2_subdev *src;
> + int err;
> +
> + dev_dbg(sd->dev, "%sable\n", enable ? "en" : "dis");
> +
> + src = tc358746_get_remote_sd(&tc358746->pads[TC358746_SINK]);
> + if (!src)
> + return -EPIPE;
> +
> + if (enable) {
> + err = pm_runtime_resume_and_get(sd->dev);
> + if (err)
> + return err;
> +
> + err = tc358746_enable_csi_lanes(tc358746, 1);
> + if (err) {
> + pm_runtime_mark_last_busy(sd->dev);
> + pm_runtime_put_sync_autosuspend(sd->dev);
> + return err;
Looks like a candidate for a goto statement.
> + }
> +
> + err = tc358746_enable_csi_module(tc358746, 1);
> + if (err) {
> + pm_runtime_mark_last_busy(sd->dev);
> + pm_runtime_put_sync_autosuspend(sd->dev);
> + return err;
> + }
> +
> + err = tc358746_enable_parallel_port(tc358746, 1);
> + if (err) {
> + pm_runtime_mark_last_busy(sd->dev);
> + pm_runtime_put_sync_autosuspend(sd->dev);
> + return err;
> + }
> +
> + err = v4l2_subdev_call(src, video, s_stream, 1);
> + if (err) {
> + pm_runtime_mark_last_busy(sd->dev);
> + pm_runtime_put_sync_autosuspend(sd->dev);
> + }
> +
> + return err;
> + }
> +
> + /*
> + * Lane disable trigger state change from LP-11 to LP-00
> + * therefore it must happen before the CSI modile is disabled.
> + */
> + err = tc358746_enable_csi_lanes(tc358746, 0);
> + if (err)
> + return err;
> +
> + err = tc358746_enable_csi_module(tc358746, 0);
> + if (err)
> + return err;
> +
> + err = tc358746_enable_parallel_port(tc358746, 0);
> + if (err)
> + return err;
> +
> + pm_runtime_mark_last_busy(sd->dev);
> + pm_runtime_put_sync_autosuspend(sd->dev);
> +
> + return v4l2_subdev_call(src, video, s_stream, 0);
> +}
> +
> +static int tc358746_enum_mbus_code(struct v4l2_subdev *sd,
> + struct v4l2_subdev_state *sd_state,
> + struct v4l2_subdev_mbus_code_enum *code)
> +{
> + const struct tc358746_format *fmt;
> +
> + fmt = tc358746_get_format_by_idx(code->pad, code->index);
> + if (IS_ERR(fmt))
> + return PTR_ERR(fmt);
> +
> + code->code = fmt->code;
> +
> + return 0;
> +}
> +
> +static struct v4l2_mbus_framefmt *
> +__tc358746_get_pad_format(struct v4l2_subdev *sd,
> + struct v4l2_subdev_state *sd_state,
> + unsigned int pad, u32 which)
> +{
> + struct tc358746 *tc358746 = to_tc358746(sd);
> +
> + switch (which) {
> + case V4L2_SUBDEV_FORMAT_TRY:
> + return v4l2_subdev_get_try_format(sd, sd_state, pad);
> + case V4L2_SUBDEV_FORMAT_ACTIVE:
> + return &tc358746->mbusfmt;
> + default:
> + return NULL;
> + }
> +}
> +
> +static int tc358746_get_fmt(struct v4l2_subdev *sd,
> + struct v4l2_subdev_state *sd_state,
> + struct v4l2_subdev_format *format)
> +{
> + struct tc358746 *tc358746 = to_tc358746(sd);
> +
> + if (format->pad >= TC358746_NR_PADS)
> + return -EINVAL;
> +
> + format->format = tc358746->mbusfmt;
> + if (format->pad == TC358746_SOURCE)
> + format->format.code = tc358746_src_mbus_code(tc358746->mbusfmt.code);
> +
> + return 0;
> +}
> +
> +static int tc358746_set_fmt(struct v4l2_subdev *sd,
> + struct v4l2_subdev_state *sd_state,
> + struct v4l2_subdev_format *format)
> +{
> + struct v4l2_mbus_framefmt *mbusformat;
> + const struct tc358746_format *fmt;
> +
> + if (format->pad >= TC358746_NR_PADS)
> + return -EINVAL;
> +
> + /* The src follows the properties from the sink */
> + if (format->pad == TC358746_SOURCE)
> + return tc358746_get_fmt(sd, sd_state, format);
> +
> + mbusformat = __tc358746_get_pad_format(sd, sd_state, format->pad,
> + format->which);
> + if (!mbusformat)
> + return -EINVAL;
> +
> + fmt = tc358746_get_format_by_code(format->pad, format->format.code);
> + if (IS_ERR(fmt))
> + fmt = tc358746_get_format_by_code(format->pad, tc358746_def_fmt.code);
> +
> + format->format.code = fmt->code;
> + format->format.field = V4L2_FIELD_NONE;
> +
> + dev_dbg(sd->dev, "Update format: %ux%u code:0x%x -> %ux%u code:0x%x",
> + mbusformat->width, mbusformat->height, mbusformat->code,
> + format->format.width, format->format.height, format->format.code);
> +
> + *mbusformat = format->format;
> +
> + return 0;
> +}
> +
> +static unsigned long tc358746_find_pll_settings(struct tc358746 *tc358746,
> + unsigned long refclk,
> + unsigned long fout)
> +
> +{
> + struct device *dev = tc358746->sd.dev;
> + unsigned long best_freq = 0;
> + u32 min_delta = 0xffffffff;
> + u16 prediv_max = 17;
> + u16 prediv_min = 1;
> + u16 m_best, mul;
> + u16 p_best, p;
> + u8 postdiv;
> +
> + if (fout > 1000 * MHZ) {
> + dev_err(dev, "HS-Clock above 1 Ghz are not supported\n");
> + return 0;
> + } else if (fout >= 500 * MHZ)
> + postdiv = 1;
> + else if (fout >= 250 * MHZ)
> + postdiv = 2;
> + else if (fout >= 125 * MHZ)
> + postdiv = 4;
> + else
> + postdiv = 8;
> +
> + for (p = prediv_min; p <= prediv_max; p++) {
> + unsigned long delta, fin;
> + u64 tmp;
> +
> + fin = DIV_ROUND_CLOSEST(refclk, p);
> + if (fin < 4 * MHZ || fin > 40 * MHZ)
> + continue;
> +
> + tmp = fout * p * postdiv;
> + do_div(tmp, fin);
> + mul = tmp;
> + if (mul > 511)
> + continue;
> +
> + tmp = mul * fin;
> + do_div(tmp, p * postdiv);
> +
> + delta = abs(fout - tmp);
> + if (delta < min_delta) {
> + p_best = p;
> + m_best = mul;
> + min_delta = delta;
> + best_freq = tmp;
> + };
> +
> + if (delta == 0)
> + break;
> + };
> +
> + if (!best_freq) {
> + dev_err(dev, "Failed find PLL frequency\n");
> + return 0;
> + }
> +
> + tc358746->pll_post_div = postdiv;
> + tc358746->pll_pre_div = p_best;
> + tc358746->pll_mul = m_best;
> +
> + if (best_freq != fout)
> + dev_warn(dev, "Request PLL freq:%lu, found PLL freq:%lu\n",
> + fout, best_freq);
> +
> + dev_dbg(dev, "Found PLL settings: freq:%lu prediv:%u multi:%u postdiv:%u\n",
> + best_freq, p_best, m_best, postdiv);
> +
> + return best_freq;
> +}
> +
> +#define TC358746_PRECISION 10
> +
> +static int
> +tc358746_link_validate(struct v4l2_subdev *sd, struct media_link *link,
> + struct v4l2_subdev_format *source_fmt,
> + struct v4l2_subdev_format *sink_fmt)
> +{
> + struct tc358746 *tc358746 = to_tc358746(sd);
> + unsigned long csi_bitrate, sensor_bitrate;
> + const struct tc358746_format *fmt;
> + unsigned int fifo_sz, tmp, n;
> + s64 sensor_pclk_rate;
> +
> + /* Check the FIFO settings */
> + fmt = tc358746_get_format_by_code(TC358746_SINK, tc358746->mbusfmt.code);
> + if (IS_ERR(fmt))
> + return PTR_ERR(fmt);
> +
> + sensor_pclk_rate = v4l2_ctrl_g_ctrl_int64(tc358746->sensor_pclk_ctrl);
> + sensor_bitrate = sensor_pclk_rate * fmt->bus_width;
> +
> + csi_bitrate = tc358746->dphy_cfg.lanes * tc358746->pll_rate;
> +
> + dev_dbg(tc358746->sd.dev,
> + "Fifo settings params: sensor-bitrate:%lu csi-bitrate:%lu",
> + sensor_bitrate, csi_bitrate);
> +
> + /* Avoid possible FIFO overflows */
> + if (csi_bitrate < sensor_bitrate) {
> + dev_err(sd->dev,
> + "Link validation failed csi-bitrate:%lu < sensor-bitrate:%lu\n",
> + csi_bitrate, sensor_bitrate);
> + return -EINVAL;
> + }
> +
> + /* Best case */
> + if (csi_bitrate == sensor_bitrate) {
> + tc358746->vb_size = TC358746_VB_DEFAULT_SIZE;
> + goto out;
> + }
> +
> + /*
> + * Avoid possible FIFO underflow in case of
> + * csi_bitrate > sensor_bitrate. For such case the chip has a internal
> + * fifo which can be used to delay the line output.
> + *
> + * Fifo size calculation:
> + *
> + * fifo-sz, image-width - in bits
> + * sbr - sensor_bitrate in bits/s
> + * csir - csi_bitrate in bits/s
> + *
> + * 1 1 1
> + * image-width * --- + fifo-sz --- >= ---- * image-width
> + * sbr sbr csir
> + *
> + * fifo-sz >= abs(sbr/csir * image-width - image-width)
> + * `-----´
> + * n
> + *
> + */
> +
> + sensor_bitrate /= TC358746_PRECISION;
> + n = csi_bitrate / sensor_bitrate;
> + tmp = (tc358746->mbusfmt.width * TC358746_PRECISION) / n;
> + fifo_sz = tc358746->mbusfmt.width - tmp;
> + fifo_sz *= fmt->bpp;
> + tc358746->vb_size = round_up(fifo_sz, 32);
> +
Please also call v4l2_subdev_link_validate_default() here.
I wonder if the above calculation wouldn't be better performed in
.s_stream() (or rather in a function being called by .s_stream()) when
enabling streaming.
> +out:
> + dev_dbg(tc358746->sd.dev,
> + "Found FIFO size[bits]:%u -> aligned to size[bits]:%u\n",
> + fifo_sz, tc358746->vb_size);
> +
> + return tc358746->vb_size > TC358746_VB_MAX_SIZE ? -EINVAL : 0;
> +}
> +
> +static int tc358746_get_mbus_config(struct v4l2_subdev *sd, unsigned int pad,
> + struct v4l2_mbus_config *config)
> +{
> + struct tc358746 *tc358746 = to_tc358746(sd);
> +
> + if (pad != TC358746_SOURCE)
> + return -EINVAL;
> +
> + config->type = V4L2_MBUS_CSI2_DPHY;
> + config->bus.mipi_csi2 = tc358746->csi_vep.bus.mipi_csi2;
> +
> + return 0;
> +}
> +
> +static int tc358746_link_setup(struct media_entity *entity,
> + const struct media_pad *local,
> + const struct media_pad *remote, u32 flags)
> +{
> + struct v4l2_subdev *sd = media_entity_to_v4l2_subdev(entity);
> + struct v4l2_subdev *sensor_sd =
> + media_entity_to_v4l2_subdev(remote->entity);
> + struct tc358746 *tc358746 = to_tc358746(sd);
> + struct device *dev = sd->dev;
> + struct v4l2_ctrl *ctrl;
> +
> + /* no special requirements on source pads */
> + if (local->flags & MEDIA_PAD_FL_SOURCE)
> + return 0;
> +
> + dev_dbg(dev, "link setup '%s':%d->'%s':%d[%d]",
> + remote->entity->name, remote->index, local->entity->name,
> + local->index, flags & MEDIA_LNK_FL_ENABLED);
> +
> + /* Required for the fifo calculation */
> + ctrl = v4l2_ctrl_find(sensor_sd->ctrl_handler, V4L2_CID_PIXEL_RATE);
> + if (!ctrl) {
> + dev_err(dev, "Subdev [%s] must support V4L2_CID_PIXEL_RATE\n",
> + sensor_sd->name);
> + return -EINVAL;
> + }
> + tc358746->sensor_pclk_ctrl = ctrl;
> +
> + return 0;
> +}
> +
> +int __maybe_unused
> +tc358746_g_register(struct v4l2_subdev *sd, struct v4l2_dbg_register *reg)
> +{
> + struct tc358746 *tc358746 = to_tc358746(sd);
> +
> + /* 32-bit registers starting from CLW_DPHYCONTTX */
> + reg->size = reg->reg < CLW_DPHYCONTTX_REG ? 2 : 4;
> +
> + if (pm_runtime_resume_and_get(sd->dev)) {
> + dev_err(sd->dev, "Failed to resume the device\n");
> + return 0;
> + }
> +
> + tc358746_read(tc358746, reg->reg, (u32 *)®->val);
> +
> + pm_runtime_mark_last_busy(sd->dev);
> + pm_runtime_put_sync_autosuspend(sd->dev);
> +
> + return 0;
> +}
> +
> +int __maybe_unused
> +tc358746_s_register(struct v4l2_subdev *sd, const struct v4l2_dbg_register *reg)
> +{
> + struct tc358746 *tc358746 = to_tc358746(sd);
> +
> + if (pm_runtime_resume_and_get(sd->dev)) {
> + dev_err(sd->dev, "Failed to resume the device\n");
> + return 0;
> + }
> +
> + tc358746_write(tc358746, (u32)reg->reg, (u32)reg->val);
> +
> + pm_runtime_mark_last_busy(sd->dev);
> + pm_runtime_put_sync_autosuspend(sd->dev);
> +
> + return 0;
> +}
> +
> +static const struct v4l2_subdev_core_ops tc358746_core_ops = {
> +#ifdef CONFIG_VIDEO_ADV_DEBUG
> + .g_register = tc358746_g_register,
> + .s_register = tc358746_s_register,
> +#endif
Have you found this to be useful ?
> +};
> +
> +static const struct v4l2_subdev_video_ops tc358746_video_ops = {
> + .s_stream = tc358746_s_stream,
> +};
> +
> +static const struct v4l2_subdev_pad_ops tc358746_pad_ops = {
> + .enum_mbus_code = tc358746_enum_mbus_code,
> + .set_fmt = tc358746_set_fmt,
> + .get_fmt = tc358746_get_fmt,
> + .link_validate = tc358746_link_validate,
> + .get_mbus_config = tc358746_get_mbus_config,
> +};
> +
> +static const struct v4l2_subdev_ops tc358746_ops = {
> + .core = &tc358746_core_ops,
> + .video = &tc358746_video_ops,
> + .pad = &tc358746_pad_ops,
> +};
> +
> +static const struct media_entity_operations tc358746_entity_ops = {
> + .get_fwnode_pad = v4l2_subdev_get_fwnode_pad_1_to_1,
> + .link_setup = tc358746_link_setup,
> + .link_validate = v4l2_subdev_link_validate,
> +};
> +
> +static int tc358746_mclk_enable(struct clk_hw *hw)
> +{
> + struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
> + unsigned int div;
> + u32 val;
> + int err;
> +
> + div = tc358746->mclk_postdiv / 2;
> + val = MCLK_HIGH(div - 1) | MCLK_LOW(div - 1);
> + dev_dbg(tc358746->sd.dev, "MCLKCTL: %u (0x%x)\n", val, val);
> + err = tc358746_write(tc358746, MCLKCTL_REG, val);
> + if (err)
> + return err;
> +
> + if (tc358746->mclk_prediv == 8)
> + val = MCLKDIV(MCLKDIV_8);
> + else if (tc358746->mclk_prediv == 4)
> + val = MCLKDIV(MCLKDIV_4);
> + else
> + val = MCLKDIV(MCLKDIV_2);
> +
> + dev_dbg(tc358746->sd.dev, "CLKCTL[MCLKDIV]: %u (0x%x)\n", val, val);
> + return tc358746_update_bits(tc358746, CLKCTL_REG, MCLKDIV_MASK, val);
> +}
> +
> +static void tc358746_mclk_disable(struct clk_hw *hw)
> +{
> + struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
> +
> + tc358746_write(tc358746, MCLKCTL_REG, 0);
> +}
> +
> +static long
> +tc358746_find_mclk_settings(struct tc358746 *tc358746, unsigned long mclk_rate)
> +{
> + unsigned long pll_rate = tc358746->pll_rate;
> + const unsigned char prediv[] = { 2, 4, 8 };
> + unsigned int mclk_prediv, mclk_postdiv;
> + struct device *dev = tc358746->sd.dev;
> + unsigned int postdiv, mclkdiv;
> + unsigned long best_mclk_rate;
> + unsigned int i;
> +
> + /*
> + * MCLK-Div
> + * -------------------´`---------------------
> + * ´ `
> + * +-------------+ +------------------------+
> + * | MCLK-PreDiv | | MCLK-PostDiv |
> + * PLL --> | (2/4/8) | --> | (mclk_low + mclk_high) | --> MCLK
> + * +-------------+ +------------------------+
> + *
> + * The register value of mclk_low/high is mclk_low/high+1, i.e.:
> + * mclk_low/high = 1 --> 2 MCLK-Ref Counts
> + * mclk_low/high = 255 --> 256 MCLK-Ref Counts == max.
> + * If mclk_low and mclk_high are 0 then MCLK is disabled.
> + *
> + * Keep it simple and support 50/50 duty cycles only for now,
> + * so the calc will be:
> + *
> + * MCLK = PLL / (MCLK-PreDiv * 2 * MCLK-PostDiv)
> + */
> +
> + if (mclk_rate == tc358746->mclk_rate)
> + return mclk_rate;
> +
> + /* Highest possible rate */
> + mclkdiv = pll_rate / mclk_rate;
> + if (mclkdiv <= 8) {
> + mclk_prediv = 2;
> + mclk_postdiv = 4;
> + best_mclk_rate = pll_rate / (2 * 4);
> + goto out;
> + }
> +
> + /* First check the prediv */
> + for (i = 0; i < ARRAY_SIZE(prediv); i++) {
> + postdiv = mclkdiv / prediv[i];
> +
> + if (postdiv % 2)
> + continue;
> +
> + if (postdiv >= 4 && postdiv <= 512) {
> + mclk_prediv = prediv[i];
> + mclk_postdiv = postdiv;
> + best_mclk_rate = pll_rate / (prediv[i] * postdiv);
> + goto out;
> + }
> + }
> +
> + /* No suitable prediv found, so try to adjust the postdiv */
> + for (postdiv = 4; postdiv <= 512; postdiv += 2) {
> + unsigned int pre;
> +
> + pre = mclkdiv / postdiv;
> + if (pre == 2 || pre == 4 || pre == 8) {
> + mclk_prediv = pre;
> + mclk_postdiv = postdiv;
> + best_mclk_rate = pll_rate / (pre * postdiv);
> + goto out;
> + }
> + }
> +
> + /* The MCLK <-> PLL gap is to high -> use largest possible div */
> + mclk_prediv = 8;
> + mclk_postdiv = 512;
> + best_mclk_rate = pll_rate / (8 * 512);
> +
> +out:
> + tc358746->mclk_prediv = mclk_prediv;
> + tc358746->mclk_postdiv = mclk_postdiv;
> + tc358746->mclk_rate = best_mclk_rate;
> +
> + if (best_mclk_rate != mclk_rate)
> + dev_warn(dev, "Request MCLK freq:%lu, found MCLK freq:%lu\n",
> + mclk_rate, best_mclk_rate);
> +
> + dev_dbg(dev, "Found MCLK settings: freq:%lu prediv:%u postdiv:%u\n",
> + best_mclk_rate, mclk_prediv, mclk_postdiv);
> +
> + return best_mclk_rate;
> +}
> +
> +unsigned long tc358746_recalc_rate(struct clk_hw *hw, unsigned long parent_rate)
> +{
> + struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
> + unsigned int prediv, postdiv;
> + u32 val;
> + int err;
> +
> + err = tc358746_read(tc358746, MCLKCTL_REG, &val);
> + if (err)
> + return 0;
> +
> + postdiv = FIELD_GET(MCLK_LOW_MASK, val) + 1;
> + postdiv += FIELD_GET(MCLK_HIGH_MASK, val) + 1;
> +
> + err = tc358746_read(tc358746, CLKCTL_REG, &val);
> + if (err)
> + return 0;
> +
> + prediv = FIELD_GET(MCLKDIV_MASK, val);
> + if (prediv == MCLKDIV_8)
> + prediv = 8;
> + else if (prediv == MCLKDIV_4)
> + prediv = 4;
> + else
> + prediv = 2;
> +
> + return tc358746->pll_rate / (prediv * postdiv);
> +}
> +
> +static long tc358746_mclk_round_rate(struct clk_hw *hw, unsigned long rate,
> + unsigned long *parent_rate)
> +{
> + struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
> +
> + *parent_rate = tc358746->pll_rate;
> +
> + return tc358746_find_mclk_settings(tc358746, rate);
> +}
> +
> +static int tc358746_mclk_set_rate(struct clk_hw *hw, unsigned long rate,
> + unsigned long parent_rate)
> +{
> + struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
> +
> + tc358746_find_mclk_settings(tc358746, rate);
> +
> + return tc358746_mclk_enable(hw);
> +}
> +
> +static const struct clk_ops tc358746_mclk_ops = {
> + .enable = tc358746_mclk_enable,
> + .disable = tc358746_mclk_disable,
> + .recalc_rate = tc358746_recalc_rate,
> + .round_rate = tc358746_mclk_round_rate,
> + .set_rate = tc358746_mclk_set_rate,
> +};
> +
> +static int tc358746_notify_bound(struct v4l2_async_notifier *notifier,
> + struct v4l2_subdev *sd,
> + struct v4l2_async_subdev *asd)
> +{
> + struct tc358746 *tc358746 =
> + container_of(notifier, struct tc358746, notifier);
> + struct media_pad *sink = &tc358746->pads[TC358746_SINK];
> +
> + return v4l2_create_fwnode_links_to_pad(sd, sink, MEDIA_LNK_FL_ENABLED);
> +}
> +
> +static const struct v4l2_async_notifier_operations tc358746_notify_ops = {
> + .bound = tc358746_notify_bound,
> +};
> +
> +static int tc358746_async_register(struct tc358746 *tc358746)
> +{
> + struct v4l2_fwnode_endpoint vep = {
> + .bus_type = V4L2_MBUS_PARALLEL,
> + };
> + struct v4l2_async_subdev *asd;
> + struct fwnode_handle *ep;
> + int err;
> +
> + ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(tc358746->sd.dev),
> + TC358746_SINK, 0, 0);
> + if (!ep)
> + return -ENOTCONN;
> +
> + err = v4l2_fwnode_endpoint_parse(ep, &vep);
> + if (err) {
> + fwnode_handle_put(ep);
> + return err;
> + }
> +
> + v4l2_async_nf_init(&tc358746->notifier);
> + asd = v4l2_async_nf_add_fwnode_remote(&tc358746->notifier, ep,
> + struct v4l2_async_subdev);
> + if (IS_ERR(asd)) {
> + fwnode_handle_put(ep);
> + return PTR_ERR(asd);
> + }
> +
> + fwnode_handle_put(ep);
> +
> + tc358746->notifier.ops = &tc358746_notify_ops;
> +
> + err = v4l2_async_subdev_nf_register(&tc358746->sd, &tc358746->notifier);
> + if (err) {
> + v4l2_async_nf_cleanup(&tc358746->notifier);
> + return err;
> + }
> +
> + tc358746->sd.fwnode = fwnode_graph_get_endpoint_by_id(
> + dev_fwnode(tc358746->sd.dev), TC358746_SOURCE, 0, 0);
> +
> + err = v4l2_async_register_subdev(&tc358746->sd);
> + if (err) {
> + v4l2_async_nf_unregister(&tc358746->notifier);
> + v4l2_async_nf_cleanup(&tc358746->notifier);
> + }
> +
> + return err;
> +}
> +
> +static int tc358746_probe(struct i2c_client *client)
> +{
> + struct clk_init_data mclk_initdata = { };
> + struct device *dev = &client->dev;
> + struct v4l2_fwnode_endpoint *vep;
> + unsigned long csi_link_rate;
> + struct tc358746 *tc358746;
> + struct fwnode_handle *ep;
> + unsigned char csi_lanes;
> + struct v4l2_subdev *sd;
> + struct v4l2_ctrl *ctrl;
> + unsigned long refclk;
> + unsigned int i;
> + int err;
> + u32 val;
> +
> + tc358746 = devm_kzalloc(&client->dev, sizeof(*tc358746), GFP_KERNEL);
> + if (!tc358746)
> + return -ENOMEM;
> +
> + tc358746->regmap = devm_regmap_init_i2c(client, &tc358746_regmap_config);
> + if (IS_ERR(tc358746->regmap))
> + return dev_err_probe(dev, PTR_ERR(tc358746->regmap),
> + "Failed to init regmap\n");
> +
> + tc358746->refclk = devm_clk_get(dev, "refclk");
> + if (IS_ERR(tc358746->refclk))
> + return dev_err_probe(dev, PTR_ERR(tc358746->refclk),
> + "Failed to get refclk\n");
> +
> + err = clk_prepare_enable(tc358746->refclk);
> + if (err)
> + return dev_err_probe(dev, err,
> + "Failed to enable refclk\n");
> +
> + refclk = clk_get_rate(tc358746->refclk);
> + clk_disable_unprepare(tc358746->refclk);
> +
> + if (refclk < 6 * MHZ || refclk > 40 * MHZ)
> + return dev_err_probe(dev, -EINVAL, "Invalid refclk range\n");
> +
> + for (i = 0; i < ARRAY_SIZE(tc358746_supplies); i++)
> + tc358746->supplies[i].supply = tc358746_supplies[i];
> +
> + err = devm_regulator_bulk_get(dev, ARRAY_SIZE(tc358746_supplies),
> + tc358746->supplies);
> + if (err)
> + return dev_err_probe(dev, err, "Failed to get supplies\n");
> +
> + tc358746->reset_gpio = devm_gpiod_get_optional(dev, "reset",
> + GPIOD_OUT_HIGH);
> + if (IS_ERR(tc358746->reset_gpio))
> + return dev_err_probe(dev, PTR_ERR(tc358746->reset_gpio),
> + "Failed to get reset-gpios\n");
> +
> + sd = &tc358746->sd;
> + v4l2_i2c_subdev_init(sd, client, &tc358746_ops);
> + sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
> + sd->entity.function = MEDIA_ENT_F_VID_IF_BRIDGE;
> + sd->entity.ops = &tc358746_entity_ops;
> +
> + tc358746->pads[TC358746_SINK].flags = MEDIA_PAD_FL_SINK;
> + tc358746->pads[TC358746_SOURCE].flags = MEDIA_PAD_FL_SOURCE;
> + err = media_entity_pads_init(&sd->entity, TC358746_NR_PADS,
> + tc358746->pads);
> + if (err)
> + return dev_err_probe(dev, err,
> + "Failed to setup media-entity pads\n");
> +
> + ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(dev), TC358746_SOURCE,
> + 0, 0);
> + if (!ep) {
> + dev_err(dev, "Missing endpoint node\n");
> + err = -EINVAL;
> + goto err_mc;
> + }
> +
> + /* Currently we only support 'parallel in' -> 'csi out' */
> + vep = &tc358746->csi_vep;
> + vep->bus_type = V4L2_MBUS_CSI2_DPHY;
> + err = v4l2_fwnode_endpoint_alloc_parse(ep, vep);
> + fwnode_handle_put(ep);
> + if (err) {
> + dev_err(dev, "Failed to parse source endpoint\n");
> + goto err_mc;
> + }
> +
> + csi_lanes = vep->bus.mipi_csi2.num_data_lanes;
> + if (csi_lanes == 0 || csi_lanes > 4 ||
> + vep->nr_of_link_frequencies == 0) {
> + dev_err(dev, "error: Invalid CSI-2 settings\n");
> + err = -EINVAL;
> + goto err_vep;
> + }
> +
> + /* TODO: Add support to handle multiple link frequencies */
> + csi_link_rate = (unsigned long)vep->link_frequencies[0];
> + tc358746->pll_rate = tc358746_find_pll_settings(tc358746, refclk,
> + csi_link_rate * 2);
> + if (!tc358746->pll_rate) {
> + err = -EINVAL;
> + goto err_vep;
> + }
> +
> + err = phy_mipi_dphy_get_default_config_for_hsclk(tc358746->pll_rate,
> + csi_lanes,
> + &tc358746->dphy_cfg);
> + if (err)
> + goto err_vep;
> +
> + tc358746->mbusfmt = tc358746_def_fmt;
> + tc358746->vb_size = TC358746_VB_DEFAULT_SIZE;
> +
> + dev_set_drvdata(dev, tc358746);
> + pm_runtime_set_autosuspend_delay(dev, 200);
> + pm_runtime_use_autosuspend(dev);
> + pm_runtime_enable(dev);
> +
> + err = pm_runtime_resume_and_get(dev);
> + if (err < 0) {
> + dev_err(dev, "Failed to resume the device\n");
> + goto err_vep;
> + }
> +
> + /* Ensure that CSI interface is put into LP-11 state */
> + err = tc358746_sw_reset(tc358746);
> + if (err) {
> + pm_runtime_put_noidle(dev);
> + dev_err(dev, "Failed to reset the device\n");
> + goto err_pm;
> + }
> +
> + err = tc358746_read(tc358746, CHIPID_REG, &val);
> + pm_runtime_mark_last_busy(dev);
> + pm_runtime_put_sync_autosuspend(dev);
> + if (err) {
> + dev_err(dev, "Failed to read chipid\n");
> + err = -ENODEV;
> + goto err_pm;
> + }
> +
> + if (FIELD_GET(CHIPID, val) != 0x44) {
> + dev_err(dev, "Invalid chipid 0x%02x\n",
> + (u32)FIELD_GET(CHIPID, val));
> + err = -ENODEV;
> + goto err_pm;
> + }
> +
> + /* Optional MCLK provider support */
> + if (device_property_present(dev, "#clock-cells")) {
> + const char *mclk_name;
> +
> + /* Init to highest possibel MCLK */
> + tc358746->mclk_postdiv = 512;
> + tc358746->mclk_prediv = 8;
> +
> + mclk_name = "tc358746-mclk";
> + device_property_read_string(dev, "clock-output-names",
> + &mclk_name);
> +
> + mclk_initdata.name = mclk_name;
> + mclk_initdata.ops = &tc358746_mclk_ops;
> + tc358746->mclk_hw.init = &mclk_initdata;
> +
> + err = devm_clk_hw_register(dev, &tc358746->mclk_hw);
> + if (err) {
> + dev_err(dev, "Failed to register mclk provider\n");
> + goto err_pm;
> + }
> +
> + err = devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get,
> + &tc358746->mclk_hw);
> + if (err) {
> + dev_err(dev, "Failed to add mclk provider\n");
> + goto err_pm;
> + }
> + }
> +
> + v4l2_ctrl_handler_init(&tc358746->ctrl_hdl, 1);
> +
> + ctrl = v4l2_ctrl_new_int_menu(&tc358746->ctrl_hdl, NULL,
> + V4L2_CID_LINK_FREQ, 0, 0,
> + vep->link_frequencies);
> + if (ctrl)
> + ctrl->flags |= V4L2_CTRL_FLAG_READ_ONLY;
> +
> + tc358746->sd.ctrl_handler = &tc358746->ctrl_hdl;
> + if (tc358746->ctrl_hdl.error) {
> + err = tc358746->ctrl_hdl.error;
> + goto err_pm;
> + }
> +
> + v4l2_ctrl_handler_setup(&tc358746->ctrl_hdl);
> +
> + err = tc358746_async_register(tc358746);
> + if (err < 0)
> + goto err_ctrl;
> +
> + dev_info(dev, "%s found @ 0x%x (%s)\n", client->name,
> + client->addr, client->adapter->name);
I'd skip this to avoid adding noise to the kernel log at boot time. I
would also probably split some of the code out of the probe function as
it's fairly large. Up to you.
> +
> + return 0;
> +
> +err_ctrl:
> + v4l2_ctrl_handler_free(&tc358746->ctrl_hdl);
> +err_pm:
> + pm_runtime_disable(dev);
> + pm_runtime_set_suspended(dev);
> + pm_runtime_dont_use_autosuspend(dev);
> +err_vep:
> + v4l2_fwnode_endpoint_free(vep);
> +err_mc:
> + media_entity_cleanup(&sd->entity);
> +
> + return err;
> +}
> +
> +static int tc358746_remove(struct i2c_client *client)
> +{
> + struct v4l2_subdev *sd = i2c_get_clientdata(client);
> + struct tc358746 *tc358746 = to_tc358746(sd);
> +
> + v4l2_ctrl_handler_free(&tc358746->ctrl_hdl);
> + v4l2_fwnode_endpoint_free(&tc358746->csi_vep);
> + v4l2_async_nf_unregister(&tc358746->notifier);
> + v4l2_async_nf_cleanup(&tc358746->notifier);
> + v4l2_async_unregister_subdev(sd);
> + v4l2_device_unregister_subdev(sd);
This shouldn't be needed v4l2_async_unregister_subdev() should be
enough.
> + media_entity_cleanup(&sd->entity);
> +
> + pm_runtime_disable(sd->dev);
> + pm_runtime_set_suspended(sd->dev);
> + pm_runtime_dont_use_autosuspend(sd->dev);
> +
> + return 0;
> +}
> +
> +static int tc358746_suspend(struct device *dev)
> +{
> + struct tc358746 *tc358746 = dev_get_drvdata(dev);
> +
> + clk_disable_unprepare(tc358746->refclk);
> +
> + return regulator_bulk_disable(ARRAY_SIZE(tc358746_supplies),
> + tc358746->supplies);
Shouldn't you reenable the clock if this fails ?
> +}
> +
> +static int tc358746_resume(struct device *dev)
> +{
> + struct tc358746 *tc358746 = dev_get_drvdata(dev);
> + int err;
> +
> + gpiod_set_value(tc358746->reset_gpio, 1);
> +
> + err = regulator_bulk_enable(ARRAY_SIZE(tc358746_supplies),
> + tc358746->supplies);
> + if (err)
> + return err;
> +
> + /* min. 200ns */
> + usleep_range(10, 20);
> +
> + gpiod_set_value(tc358746->reset_gpio, 0);
> +
> + err = clk_prepare_enable(tc358746->refclk);
> + if (err)
> + return err;
The regulators need to be disabled in case of failure here and below
(and so does the clock below).
> +
> + /* min. 700us ... 1ms */
> + usleep_range(1000, 1500);
> +
> + /* Sync state */
> + err = tc358746_apply_pll_config(tc358746);
> + if (err)
> + return err;
> +
> + err = tc358746_apply_dphy_config(tc358746);
> + if (err)
> + return err;
> +
> + return tc358746_apply_misc_config(tc358746);
Does all this belong to the PM resume handler ? It seems configuration
could be handled in .s_stream() instead.
> +}
> +
> +DEFINE_RUNTIME_DEV_PM_OPS(tc358746_pm_ops, tc358746_suspend,
> + tc358746_resume, NULL);
> +
> +static const struct of_device_id __maybe_unused tc358746_of_match[] = {
> + { .compatible = "toshiba,tc358746" },
> + { },
> +};
> +MODULE_DEVICE_TABLE(of, tc358746_of_match);
> +
> +static struct i2c_driver tc358746_driver = {
> + .driver = {
> + .name = "tc358746",
> + .pm = pm_ptr(&tc358746_pm_ops),
> + .of_match_table = tc358746_of_match,
> + },
> + .probe_new = tc358746_probe,
> + .remove = tc358746_remove,
> +};
> +
> +module_i2c_driver(tc358746_driver);
> +
> +MODULE_DESCRIPTION("Toshiba TC358746 Parallel to CSI-2 bridge driver");
> +MODULE_AUTHOR("Marco Felsch <kernel@pengutronix.de>");
> +MODULE_LICENSE("GPL");
--
Regards,
Laurent Pinchart
--
linux-phy mailing list
linux-phy@lists.infradead.org
https://lists.infradead.org/mailman/listinfo/linux-phy
^ permalink raw reply [flat|nested] 34+ messages in thread
* Re: [PATCH 3/4] media: dt-bindings: add bindings for Toshiba TC358746
2022-09-04 22:35 ` Laurent Pinchart
@ 2022-09-15 13:19 ` Marco Felsch
-1 siblings, 0 replies; 34+ messages in thread
From: Marco Felsch @ 2022-09-15 13:19 UTC (permalink / raw)
To: Laurent Pinchart
Cc: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, linux-kernel, linux-phy,
devicetree, linux-media, kernel
Hi Laurent,
On 22-09-05, Laurent Pinchart wrote:
> Hi Marco,
>
> Thank you for the patch.
>
> On Thu, Aug 18, 2022 at 04:33:06PM +0200, Marco Felsch wrote:
> > Add the bindings for the Toshiba TC358746 Parallel <-> MIPI-CSI bridge
> > driver.
> >
> > Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
> > ---
> > .../bindings/media/i2c/toshiba,tc358746.yaml | 157 ++++++++++++++++++
> > 1 file changed, 157 insertions(+)
> > create mode 100644 Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
> >
> > diff --git a/Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml b/Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
> > new file mode 100644
> > index 000000000000..9783cca363c6
> > --- /dev/null
> > +++ b/Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
> > @@ -0,0 +1,157 @@
> > +# SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause)
> > +%YAML 1.2
> > +---
> > +$id: http://devicetree.org/schemas/media/i2c/toshiba,tc358746.yaml#
> > +$schema: http://devicetree.org/meta-schemas/core.yaml#
> > +
> > +title: Toshiba TC358746 Parallel to MIPI CSI2 Bridge
> > +
> > +maintainers:
> > + - Marco Felsch <kernel@pengutronix.de>
> > +
> > +description: |-
> > + The Toshiba TC358746 converts a parallel video stream into a MIPI CSI-2
> > + stream. The direction can be either parallel-in -> csi-out or csi-in ->
> > + parallel-out The chip is programmable trough I2C and SPI but the SPI
> > + interface is only supported in parallel-in -> csi-out mode.
> > +
> > + Note that the current device tree bindings only support the
> > + parallel-in -> csi-out path.
> > +
> > +properties:
> > + compatible:
> > + const: toshiba,tc358746
> > +
> > + reg:
> > + maxItems: 1
> > +
> > + clocks:
> > + description:
> > + The phandle to the reference clock source. This corresponds to the
> > + hardware pin REFCLK.
> > + maxItems: 1
> > +
> > + clock-names:
> > + const: refclk
>
> As there's a single clock, should we omit the clock name ?
Don't know, I would rather keep it to make it explicite. Many other go
that way too.
> > +# The bridge can act as clock provider for the sensor. To enable this support
> > +# #clock-cells must be specified. Attention if this feature is used than the
>
> s/than/then/
Sure, thanks.
>
> > +# mclk rate must be at least: (2 * link-frequency) / 8
> > +# `------------------´ ^
> > +# internal PLL rate smallest possible mclk-div
>
> Could this be captured in the description of the property instead of a
> comment ?
Hm.. a few (1,2) bindings using comments like this but I'm not against
it. If it belongs to the description, which property should I use? Since
there is no: clock-controller property like gpio-controller or
interrupt-controller. The clock provider will be activated based on the
#clock-cells property. But this property has nothing to with the
description since this property specifies the cell size.
> > + "#clock-cells":
> > + const: 0
> > +
> > + clock-output-names:
> > + description:
> > + The clock name of the MCLK output, the default name is tc358746-mclk.
> > + maxItems: 1
> > +
> > + vddc-supply:
> > + description: Digital core voltage supply, 1.2 volts
> > +
> > + vddio-supply:
> > + description: Digital I/O voltage supply, 1.8 volts
> > +
> > + vddmipi-supply:
> > + description: MIPI CSI phy voltage supply, 1.2 volts
> > +
> > + reset-gpios:
> > + description:
> > + The phandle and specifier for the GPIO that controls the chip reset.
> > + This corresponds to the hardware pin RESX which is physically active low.
> > + maxItems: 1
> > +
> > + ports:
> > + $ref: /schemas/graph.yaml#/properties/ports
> > + properties:
> > + port@0:
> > + $ref: /schemas/graph.yaml#/properties/port
> > + description: Input port
>
> Are the H/V sync signal polarities fixed, or should they be specified
> here ?
At the moment they are fixed. I can describe it if you want.
> Does the chip support external sync only, or also BT.656 ? In the
> latter case this needs a bus-type.
Yes, the chip also supports BT.656 but the driver doesn't support it
yet. You're right, that we should make it explicite albeit it would a
bit overhead yet since the only mode is: parallel-in with externa syncs.
> > +
> > + port@1:
> > + $ref: /schemas/graph.yaml#/$defs/port-base
> > + description: Output port
> > +
> > + properties:
> > + endpoint:
> > + $ref: /schemas/media/video-interfaces.yaml#
> > + unevaluatedProperties: false
> > +
> > + properties:
> > + data-lanes:
> > + minItems: 1
> > + maxItems: 4
> > +
> > + clock-noncontinuous: true
> > + link-frequencies: true
> > +
> > + required:
> > + - data-lanes
> > + - link-frequencies
> > +
> > + required:
> > + - port@0
> > + - port@1
> > +
> > +required:
> > + - compatible
> > + - reg
> > + - clocks
> > + - clock-names
> > + - vddc-supply
> > + - vddio-supply
> > + - vddmipi-supply
> > + - ports
> > +
> > +additionalProperties: false
> > +
> > +examples:
> > + - |
> > + #include <dt-bindings/gpio/gpio.h>
> > +
> > + i2c {
> > + #address-cells = <1>;
> > + #size-cells = <0>;
> > +
> > + csi-bridge@e {
> > + compatible = "toshiba,tc358746";
> > + reg = <0xe>;
> > +
> > + clocks = <&refclk>;
> > + clock-names = "refclk";
> > +
> > + reset-gpios = <&gpio 2 GPIO_ACTIVE_LOW>;
> > +
> > + vddc-supply = <&v1_2d>;
> > + vddio-supply = <&v1_8d>;
> > + vddmipi-supply = <&v1_2d>;
> > +
> > + /* sensor mclk provider */
> > + #clock-cells = <0>;
> > +
> > + ports {
> > + #address-cells = <1>;
> > + #size-cells = <0>;
> > +
> > + /* Input */
> > + port@0 {
> > + reg = <0>;
> > + tc358746_in: endpoint {
> > + remote-endpoint = <&sensor_out>;
> > + };
>
> Wrong indentation here.
Yes, thanks.
Regards,
Marco
> > + };
> > +
> > + /* Output */
> > + port@1 {
> > + reg = <1>;
> > + tc358746_out: endpoint {
> > + remote-endpoint = <&mipi_csi2_in>;
> > + data-lanes = <1 2>;
> > + clock-noncontinuous;
> > + link-frequencies = /bits/ 64 <216000000>;
> > + };
> > + };
> > + };
> > + };
> > + };
>
> --
> Regards,
>
> Laurent Pinchart
>
^ permalink raw reply [flat|nested] 34+ messages in thread
* Re: [PATCH 3/4] media: dt-bindings: add bindings for Toshiba TC358746
@ 2022-09-15 13:19 ` Marco Felsch
0 siblings, 0 replies; 34+ messages in thread
From: Marco Felsch @ 2022-09-15 13:19 UTC (permalink / raw)
To: Laurent Pinchart
Cc: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, linux-kernel, linux-phy,
devicetree, linux-media, kernel
Hi Laurent,
On 22-09-05, Laurent Pinchart wrote:
> Hi Marco,
>
> Thank you for the patch.
>
> On Thu, Aug 18, 2022 at 04:33:06PM +0200, Marco Felsch wrote:
> > Add the bindings for the Toshiba TC358746 Parallel <-> MIPI-CSI bridge
> > driver.
> >
> > Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
> > ---
> > .../bindings/media/i2c/toshiba,tc358746.yaml | 157 ++++++++++++++++++
> > 1 file changed, 157 insertions(+)
> > create mode 100644 Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
> >
> > diff --git a/Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml b/Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
> > new file mode 100644
> > index 000000000000..9783cca363c6
> > --- /dev/null
> > +++ b/Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
> > @@ -0,0 +1,157 @@
> > +# SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause)
> > +%YAML 1.2
> > +---
> > +$id: http://devicetree.org/schemas/media/i2c/toshiba,tc358746.yaml#
> > +$schema: http://devicetree.org/meta-schemas/core.yaml#
> > +
> > +title: Toshiba TC358746 Parallel to MIPI CSI2 Bridge
> > +
> > +maintainers:
> > + - Marco Felsch <kernel@pengutronix.de>
> > +
> > +description: |-
> > + The Toshiba TC358746 converts a parallel video stream into a MIPI CSI-2
> > + stream. The direction can be either parallel-in -> csi-out or csi-in ->
> > + parallel-out The chip is programmable trough I2C and SPI but the SPI
> > + interface is only supported in parallel-in -> csi-out mode.
> > +
> > + Note that the current device tree bindings only support the
> > + parallel-in -> csi-out path.
> > +
> > +properties:
> > + compatible:
> > + const: toshiba,tc358746
> > +
> > + reg:
> > + maxItems: 1
> > +
> > + clocks:
> > + description:
> > + The phandle to the reference clock source. This corresponds to the
> > + hardware pin REFCLK.
> > + maxItems: 1
> > +
> > + clock-names:
> > + const: refclk
>
> As there's a single clock, should we omit the clock name ?
Don't know, I would rather keep it to make it explicite. Many other go
that way too.
> > +# The bridge can act as clock provider for the sensor. To enable this support
> > +# #clock-cells must be specified. Attention if this feature is used than the
>
> s/than/then/
Sure, thanks.
>
> > +# mclk rate must be at least: (2 * link-frequency) / 8
> > +# `------------------´ ^
> > +# internal PLL rate smallest possible mclk-div
>
> Could this be captured in the description of the property instead of a
> comment ?
Hm.. a few (1,2) bindings using comments like this but I'm not against
it. If it belongs to the description, which property should I use? Since
there is no: clock-controller property like gpio-controller or
interrupt-controller. The clock provider will be activated based on the
#clock-cells property. But this property has nothing to with the
description since this property specifies the cell size.
> > + "#clock-cells":
> > + const: 0
> > +
> > + clock-output-names:
> > + description:
> > + The clock name of the MCLK output, the default name is tc358746-mclk.
> > + maxItems: 1
> > +
> > + vddc-supply:
> > + description: Digital core voltage supply, 1.2 volts
> > +
> > + vddio-supply:
> > + description: Digital I/O voltage supply, 1.8 volts
> > +
> > + vddmipi-supply:
> > + description: MIPI CSI phy voltage supply, 1.2 volts
> > +
> > + reset-gpios:
> > + description:
> > + The phandle and specifier for the GPIO that controls the chip reset.
> > + This corresponds to the hardware pin RESX which is physically active low.
> > + maxItems: 1
> > +
> > + ports:
> > + $ref: /schemas/graph.yaml#/properties/ports
> > + properties:
> > + port@0:
> > + $ref: /schemas/graph.yaml#/properties/port
> > + description: Input port
>
> Are the H/V sync signal polarities fixed, or should they be specified
> here ?
At the moment they are fixed. I can describe it if you want.
> Does the chip support external sync only, or also BT.656 ? In the
> latter case this needs a bus-type.
Yes, the chip also supports BT.656 but the driver doesn't support it
yet. You're right, that we should make it explicite albeit it would a
bit overhead yet since the only mode is: parallel-in with externa syncs.
> > +
> > + port@1:
> > + $ref: /schemas/graph.yaml#/$defs/port-base
> > + description: Output port
> > +
> > + properties:
> > + endpoint:
> > + $ref: /schemas/media/video-interfaces.yaml#
> > + unevaluatedProperties: false
> > +
> > + properties:
> > + data-lanes:
> > + minItems: 1
> > + maxItems: 4
> > +
> > + clock-noncontinuous: true
> > + link-frequencies: true
> > +
> > + required:
> > + - data-lanes
> > + - link-frequencies
> > +
> > + required:
> > + - port@0
> > + - port@1
> > +
> > +required:
> > + - compatible
> > + - reg
> > + - clocks
> > + - clock-names
> > + - vddc-supply
> > + - vddio-supply
> > + - vddmipi-supply
> > + - ports
> > +
> > +additionalProperties: false
> > +
> > +examples:
> > + - |
> > + #include <dt-bindings/gpio/gpio.h>
> > +
> > + i2c {
> > + #address-cells = <1>;
> > + #size-cells = <0>;
> > +
> > + csi-bridge@e {
> > + compatible = "toshiba,tc358746";
> > + reg = <0xe>;
> > +
> > + clocks = <&refclk>;
> > + clock-names = "refclk";
> > +
> > + reset-gpios = <&gpio 2 GPIO_ACTIVE_LOW>;
> > +
> > + vddc-supply = <&v1_2d>;
> > + vddio-supply = <&v1_8d>;
> > + vddmipi-supply = <&v1_2d>;
> > +
> > + /* sensor mclk provider */
> > + #clock-cells = <0>;
> > +
> > + ports {
> > + #address-cells = <1>;
> > + #size-cells = <0>;
> > +
> > + /* Input */
> > + port@0 {
> > + reg = <0>;
> > + tc358746_in: endpoint {
> > + remote-endpoint = <&sensor_out>;
> > + };
>
> Wrong indentation here.
Yes, thanks.
Regards,
Marco
> > + };
> > +
> > + /* Output */
> > + port@1 {
> > + reg = <1>;
> > + tc358746_out: endpoint {
> > + remote-endpoint = <&mipi_csi2_in>;
> > + data-lanes = <1 2>;
> > + clock-noncontinuous;
> > + link-frequencies = /bits/ 64 <216000000>;
> > + };
> > + };
> > + };
> > + };
> > + };
>
> --
> Regards,
>
> Laurent Pinchart
>
--
linux-phy mailing list
linux-phy@lists.infradead.org
https://lists.infradead.org/mailman/listinfo/linux-phy
^ permalink raw reply [flat|nested] 34+ messages in thread
* Re: [PATCH 4/4] media: tc358746: add Toshiba TC358746 Parallel to CSI-2 bridge driver
2022-09-05 20:03 ` Laurent Pinchart
@ 2022-09-15 16:54 ` Marco Felsch
-1 siblings, 0 replies; 34+ messages in thread
From: Marco Felsch @ 2022-09-15 16:54 UTC (permalink / raw)
To: Laurent Pinchart
Cc: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, linux-kernel, linux-phy,
devicetree, linux-media, kernel
Hi Laurent,
On 22-09-05, Laurent Pinchart wrote:
> Hi Marco,
>
> Thank you for the patch.
>
> On Thu, Aug 18, 2022 at 04:33:07PM +0200, Marco Felsch wrote:
> > Adding support for the TC358746 parallel <-> MIPI CSI bridge. This chip
> > supports two operating modes:
> > 1st) parallel-in -> mipi-csi out
> > 2nd) mipi-csi in -> parallel out
> >
> > This patch only adds the support for the 1st mode.
> >
> > Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
> > ---
> > drivers/media/i2c/Kconfig | 17 +
> > drivers/media/i2c/Makefile | 1 +
> > drivers/media/i2c/tc358746.c | 1645 ++++++++++++++++++++++++++++++++++
> > 3 files changed, 1663 insertions(+)
> > create mode 100644 drivers/media/i2c/tc358746.c
> >
> > diff --git a/drivers/media/i2c/Kconfig b/drivers/media/i2c/Kconfig
> > index 7806d4b81716..aefb9c9e0c08 100644
> > --- a/drivers/media/i2c/Kconfig
> > +++ b/drivers/media/i2c/Kconfig
> > @@ -1272,6 +1272,23 @@ config VIDEO_TC358743_CEC
> > When selected the tc358743 will support the optional
> > HDMI CEC feature.
> >
> > +config VIDEO_TC358746
> > + tristate "Toshiba TC358746 parallel-CSI2 bridge"
> > + depends on VIDEO_DEV && I2C
> > + select VIDEO_V4L2_SUBDEV_API
> > + select MEDIA_CONTROLLER
> > + select V4L2_FWNODE
> > + select GENERIC_PHY_MIPI_DPHY
> > + select REGMAP_I2C
> > + select COMMON_CLK
> > + help
> > + Support for the Toshiba TC358746 parallel to MIPI CSI-2 bridge.
> > + The bridge can work in both directions but currently only the
> > + parallel-in / csi-out path is supported.
> > +
> > + To compile this driver as a module, choose M here: the
> > + module will be called tc358746.
> > +
> > config VIDEO_TVP514X
> > tristate "Texas Instruments TVP514x video decoder"
> > depends on VIDEO_DEV && I2C
> > diff --git a/drivers/media/i2c/Makefile b/drivers/media/i2c/Makefile
> > index 0a2933103dd9..d1096c2ab480 100644
> > --- a/drivers/media/i2c/Makefile
> > +++ b/drivers/media/i2c/Makefile
> > @@ -118,6 +118,7 @@ obj-$(CONFIG_VIDEO_SONY_BTF_MPX) += sony-btf-mpx.o
> > obj-$(CONFIG_VIDEO_SR030PC30) += sr030pc30.o
> > obj-$(CONFIG_VIDEO_ST_MIPID02) += st-mipid02.o
> > obj-$(CONFIG_VIDEO_TC358743) += tc358743.o
> > +obj-$(CONFIG_VIDEO_TC358746) += tc358746.o
> > obj-$(CONFIG_VIDEO_TDA1997X) += tda1997x.o
> > obj-$(CONFIG_VIDEO_TDA7432) += tda7432.o
> > obj-$(CONFIG_VIDEO_TDA9840) += tda9840.o
> > diff --git a/drivers/media/i2c/tc358746.c b/drivers/media/i2c/tc358746.c
> > new file mode 100644
> > index 000000000000..7b71d0cf72a9
> > --- /dev/null
> > +++ b/drivers/media/i2c/tc358746.c
> > @@ -0,0 +1,1645 @@
> > +// SPDX-License-Identifier: GPL-2.0-only
> > +/*
> > + * TC358746 - Parallel <-> CSI-2 Bridge
> > + *
> > + * Copyright 2022 Marco Felsch <kernel@pengutronix.de>
> > + *
> > + * Notes:
> > + * - Currently only 'Parallel-in -> CSI-out' mode is supported!
> > + */
> > +
> > +#include <linux/bitfield.h>
> > +#include <linux/clk.h>
> > +#include <linux/clk-provider.h>
> > +#include <linux/delay.h>
> > +#include <linux/i2c.h>
> > +#include <linux/interrupt.h>
> > +#include <linux/kernel.h>
> > +#include <linux/module.h>
> > +#include <linux/phy/phy-mipi-dphy.h>
> > +#include <linux/property.h>
> > +#include <linux/pm_runtime.h>
> > +#include <linux/regmap.h>
> > +#include <media/v4l2-ctrls.h>
> > +#include <media/v4l2-device.h>
> > +#include <media/v4l2-fwnode.h>
> > +#include <media/v4l2-mc.h>
> > +
> > +/* 16-bit registers */
> > +#define CHIPID_REG 0x0000
> > +#define CHIPID GENMASK(15, 8)
> > +
> > +#define SYSCTL_REG 0x0002
> > +#define SRESET BIT(0)
> > +
> > +#define CONFCTL_REG 0x0004
> > +#define PDATAF_MASK GENMASK(9, 8)
> > +#define PDATAF_MODE0 0
> > +#define PDATAF_MODE1 1
> > +#define PDATAF_MODE2 2
> > +#define PDATAF(val) FIELD_PREP(PDATAF_MASK, (val))
> > +#define PPEN BIT(6)
> > +#define DATALANE_MASK GENMASK(1, 0)
> > +
> > +#define FIFOCTL_REG 0x0006
> > +#define DATAFMT_REG 0x0008
> > +#define PDFMT(val) FIELD_PREP(GENMASK(7, 4), (val))
> > +
> > +#define MCLKCTL_REG 0x000c
> > +#define MCLK_HIGH_MASK GENMASK(15, 8)
> > +#define MCLK_LOW_MASK GENMASK(7, 0)
> > +#define MCLK_HIGH(val) FIELD_PREP(MCLK_HIGH_MASK, (val))
> > +#define MCLK_LOW(val) FIELD_PREP(MCLK_LOW_MASK, (val))
> > +
> > +#define PLLCTL0_REG 0x0016
> > +#define PLL_PRD_MASK GENMASK(15, 12)
> > +#define PLL_PRD(val) FIELD_PREP(PLL_PRD_MASK, (val))
> > +#define PLL_FBD_MASK GENMASK(8, 0)
> > +#define PLL_FBD(val) FIELD_PREP(PLL_FBD_MASK, (val))
> > +
> > +#define PLLCTL1_REG 0x0018
> > +#define PLL_FRS_MASK GENMASK(11, 10)
> > +#define PLL_FRS(val) FIELD_PREP(PLL_FRS_MASK, (val))
> > +#define CKEN BIT(4)
> > +#define RESETB BIT(1)
> > +#define PLL_EN BIT(0)
> > +
> > +#define CLKCTL_REG 0x0020
> > +#define MCLKDIV_MASK GENMASK(3, 2)
> > +#define MCLKDIV(val) FIELD_PREP(MCLKDIV_MASK, (val))
> > +#define MCLKDIV_8 0
> > +#define MCLKDIV_4 1
> > +#define MCLKDIV_2 2
> > +
> > +#define WORDCNT_REG 0x0022
> > +#define PP_MISC_REG 0x0032
> > +#define FRMSTOP BIT(15)
> > +#define RSTPTR BIT(14)
> > +
> > +/* 32-bit registers */
> > +#define CLW_DPHYCONTTX_REG 0x0100
> > +#define CLW_CNTRL_REG 0x0140
> > +#define D0W_CNTRL_REG 0x0144
> > +#define LANEDISABLE BIT(0)
> > +
> > +#define STARTCNTRL_REG 0x0204
> > +#define START BIT(0)
> > +
> > +#define LINEINITCNT_REG 0x0210
> > +#define LPTXTIMECNT_REG 0x0214
> > +#define TCLK_HEADERCNT_REG 0x0218
> > +#define TCLK_ZEROCNT(val) FIELD_PREP(GENMASK(15, 8), (val))
> > +#define TCLK_PREPARECNT(val) FIELD_PREP(GENMASK(6, 0), (val))
> > +
> > +#define TCLK_TRAILCNT_REG 0x021C
> > +#define THS_HEADERCNT_REG 0x0220
> > +#define THS_ZEROCNT(val) FIELD_PREP(GENMASK(14, 8), (val))
> > +#define THS_PREPARECNT(val) FIELD_PREP(GENMASK(6, 0), (val))
> > +
> > +#define TWAKEUP_REG 0x0224
> > +#define TCLK_POSTCNT_REG 0x0228
> > +#define THS_TRAILCNT_REG 0x022C
> > +#define HSTXVREGEN_REG 0x0234
> > +#define TXOPTIONCNTRL_REG 0x0238
> > +#define CSI_CONTROL_REG 0x040C
> > +#define CSI_MODE BIT(15)
> > +#define TXHSMD BIT(7)
> > +#define NOL(val) FIELD_PREP(GENMASK(2, 1), (val))
> > +
> > +#define CSI_CONFW_REG 0x0500
> > +#define MODE(val) FIELD_PREP(GENMASK(31, 29), (val))
> > +#define MODE_SET 0x5
> > +#define ADDRESS(val) FIELD_PREP(GENMASK(28, 24), (val))
> > +#define CSI_CONTROL_ADDRESS 0x3
> > +#define DATA(val) FIELD_PREP(GENMASK(15, 0), (val))
> > +
> > +#define CSI_START_REG 0x0518
> > +#define STRT BIT(0)
> > +
> > +static const struct v4l2_mbus_framefmt tc358746_def_fmt = {
> > + .width = 640,
> > + .height = 480,
> > + .code = MEDIA_BUS_FMT_UYVY8_2X8,
> > + .field = V4L2_FIELD_NONE,
> > + .colorspace = V4L2_COLORSPACE_DEFAULT,
> > + .ycbcr_enc = V4L2_YCBCR_ENC_DEFAULT,
> > + .quantization = V4L2_QUANTIZATION_DEFAULT,
> > + .xfer_func = V4L2_XFER_FUNC_DEFAULT,
> > +};
> > +
> > +static const char * const tc358746_supplies[] = {
> > + "vddc", "vddio", "vddmipi"
> > +};
> > +
> > +enum {
> > + TC358746_SINK,
> > + TC358746_SOURCE,
> > + TC358746_NR_PADS
> > +};
> > +
> > +struct tc358746 {
> > + struct v4l2_subdev sd;
> > + struct media_pad pads[TC358746_NR_PADS];
> > + struct v4l2_async_notifier notifier;
> > + struct v4l2_mbus_framefmt mbusfmt;
>
> Could you use the active state API instead of manually storing mbusfmt
> here ? It involves
I will do that, thanks for the hint and it also elimates a few basic
checks like the pad-num check.
> - Implementing the .init_cfg() operation
> - Calling v4l2_subdev_init_finalize() in probe
> - Replacing calls to __tc358746_get_pad_format() with
> v4l2_subdev_get_pad_format()
> - Propagating the format from sink to source in tc358746_set_fmt()
> - Dropping tc358746_src_mbus_code() from tc358746_get_fmt() and simply
> retrieving the format using v4l2_subdev_get_pad_format() there
> - Dropping this field
>
> The formats for both the ACTIVE and TRY states will then be stored in
> the subdev state, unconditionally. You can retrieve the active state
> with v4l2_subdev_get_locked_active_state() in tc358746_s_stream().
>
> > + struct v4l2_fwnode_endpoint csi_vep;
> > +
> > + struct v4l2_ctrl_handler ctrl_hdl;
> > +
> > + struct regmap *regmap;
> > + struct clk *refclk;
> > + struct gpio_desc *reset_gpio;
> > + struct regulator_bulk_data supplies[ARRAY_SIZE(tc358746_supplies)];
> > +
> > + struct clk_hw mclk_hw;
> > + unsigned long mclk_rate;
> > + u8 mclk_prediv;
> > + u16 mclk_postdiv;
> > +
> > + unsigned long pll_rate;
> > + u8 pll_post_div;
> > + u16 pll_pre_div;
> > + u16 pll_mul;
> > +
> > + struct v4l2_ctrl *sensor_pclk_ctrl;
> > +
> > +#define TC358746_VB_MAX_SIZE (511 * 32)
> > +#define TC358746_VB_DEFAULT_SIZE (1 * 32)
> > + unsigned int vb_size; /* Video buffer size in bits */
> > +
> > + struct phy_configure_opts_mipi_dphy dphy_cfg;
> > +};
> > +
> > +static inline struct tc358746 *to_tc358746(struct v4l2_subdev *sd)
> > +{
> > + return container_of(sd, struct tc358746, sd);
> > +}
> > +
> > +static inline struct tc358746 *clk_hw_to_tc358746(struct clk_hw *hw)
> > +{
> > + return container_of(hw, struct tc358746, mclk_hw);
> > +}
> > +
> > +struct tc358746_format {
> > + u32 code;
> > + bool csi_format;
> > + unsigned char bus_width;
> > + unsigned char bpp;
> > + /* Register values */
> > + u8 pdformat; /* Peripheral Data Format */
> > + u8 pdataf; /* Parallel Data Format Option */
> > +};
> > +
> > +enum {
> > + PDFORMAT_RAW8 = 0,
> > + PDFORMAT_RAW10,
> > + PDFORMAT_RAW12,
> > + PDFORMAT_RGB888,
> > + PDFORMAT_RGB666,
> > + PDFORMAT_RGB565,
> > + PDFORMAT_YUV422_8BIT,
> > + /* RESERVED = 7 */
> > + PDFORMAT_RAW14 = 8,
> > + PDFORMAT_YUV422_10BIT,
> > + PDFORMAT_YUV444,
> > +};
> > +
> > +/* Check tc358746_src_mbus_code() if you add new formats */
> > +static const struct tc358746_format tc358746_formats[] = {
> > + {
> > + .code = MEDIA_BUS_FMT_UYVY8_2X8,
> > + .bus_width = 8,
> > + .bpp = 16,
> > + .pdformat = PDFORMAT_YUV422_8BIT,
> > + .pdataf = PDATAF_MODE0,
> > + }, {
> > + .code = MEDIA_BUS_FMT_UYVY8_1X16,
> > + .csi_format = true,
> > + .bus_width = 16,
> > + .bpp = 16,
> > + .pdformat = PDFORMAT_YUV422_8BIT,
> > + .pdataf = PDATAF_MODE1,
> > + }, {
> > + .code = MEDIA_BUS_FMT_YUYV8_1X16,
> > + .csi_format = true,
> > + .bus_width = 16,
> > + .bpp = 16,
> > + .pdformat = PDFORMAT_YUV422_8BIT,
> > + .pdataf = PDATAF_MODE2,
> > + }, {
> > + .code = MEDIA_BUS_FMT_UYVY10_2X10,
> > + .bus_width = 10,
> > + .bpp = 20,
> > + .pdformat = PDFORMAT_YUV422_10BIT,
> > + .pdataf = PDATAF_MODE0, /* don't care */
> > + }, {
> > + /* in datasheet listed as YUV444 */
> > + .code = MEDIA_BUS_FMT_GBR888_1X24,
> > + .csi_format = true,
> > + .bus_width = 24,
> > + .bpp = 24,
> > + .pdformat = PDFORMAT_YUV444,
>
> This looks quite weird, does 24-bit RGB really map to the CSI-2 YUV444
> data type ?
It is written in the comments.. but I can drop for now since I don't
have a device to ensure it.
> > + .pdataf = PDATAF_MODE0, /* don't care */
> > + },
> > +};
> > +
> > +/* Get n-th format for pad */
> > +static const struct tc358746_format *
> > +tc358746_get_format_by_idx(unsigned int pad, unsigned int index)
> > +{
> > + unsigned int idx = 0;
> > + unsigned int i;
> > +
> > + if (pad >= TC358746_NR_PADS)
> > + return ERR_PTR(-EINVAL);
>
> That should be tested by the subdev core, I think you can drop the
> check. Same below.
Yes, thanks :)
> > +
> > + for (i = 0; i < ARRAY_SIZE(tc358746_formats); i++) {
> > + const struct tc358746_format *fmt = &tc358746_formats[i];
> > +
> > + if ((pad == TC358746_SOURCE && fmt->csi_format) ||
> > + (pad == TC358746_SINK)) {
> > + if (idx == index)
> > + return fmt;
> > + idx++;
> > + }
> > + }
> > +
> > + return ERR_PTR(-EINVAL);
> > +}
> > +
> > +static const struct tc358746_format *
> > +tc358746_get_format_by_code(unsigned int pad, u32 code)
> > +{
> > + unsigned int i;
> > +
> > + if (pad >= TC358746_NR_PADS)
> > + return ERR_PTR(-EINVAL);
> > +
> > + for (i = 0; i < ARRAY_SIZE(tc358746_formats); i++) {
> > + const struct tc358746_format *fmt = &tc358746_formats[i];
> > +
> > + if (pad == TC358746_SINK && fmt->code == code)
> > + return fmt;
> > +
> > + if (pad == TC358746_SOURCE && fmt->csi_format &&
> > + fmt->code == code)
> > + return fmt;
>
> You could also write
>
> if (pad == TC358746_SOURCE && !fmt->csi_format)
> continue;
>
> if (fmt->code == code)
> return fmt;
>
> Up to you.
Okay, I will do that.
> > + }
> > +
> > + return ERR_PTR(-EINVAL);
> > +}
> > +
> > +static u32 tc358746_src_mbus_code(u32 code)
> > +{
> > + switch (code) {
> > + case MEDIA_BUS_FMT_UYVY8_2X8:
> > + return MEDIA_BUS_FMT_UYVY8_1X16;
> > + case MEDIA_BUS_FMT_UYVY10_2X10:
> > + return MEDIA_BUS_FMT_UYVY10_1X20;
> > + default:
> > + return code;
> > + }
> > +}
> > +
> > +static bool tc358746_writeable_reg(struct device *dev, unsigned int reg)
> > +{
> > + switch (reg) {
> > + case SYSCTL_REG ... CSI_START_REG:
> > + return true;
> > + default:
> > + return false;
> > + }
> > +}
> > +
> > +static bool tc358746_readable_reg(struct device *dev, unsigned int reg)
> > +{
> > + switch (reg) {
> > + case CHIPID_REG ... CSI_START_REG:
> > + return true;
> > + default:
> > + return false;
> > + }
> > +}
> > +
> > +static const struct regmap_config tc358746_regmap_config = {
> > + .name = "tc358746",
> > + .reg_bits = 16,
> > + .val_bits = 16,
> > + .max_register = CSI_START_REG,
> > + .writeable_reg = tc358746_writeable_reg,
> > + .readable_reg = tc358746_readable_reg,
> > + .reg_format_endian = REGMAP_ENDIAN_BIG,
> > + .val_format_endian = REGMAP_ENDIAN_BIG,
> > +};
> > +
> > +static int tc358746_write(struct tc358746 *tc358746, u32 reg, u32 val)
> > +{
> > + size_t count;
> > +
> > + /* 32-bit registers starting from CLW_DPHYCONTTX */
> > + count = reg < CLW_DPHYCONTTX_REG ? 1 : 2;
> > +
> > + return regmap_bulk_write(tc358746->regmap, reg, &val, count);
> > +}
> > +
> > +static int tc358746_read(struct tc358746 *tc358746, u32 reg, u32 *val)
> > +{
> > + size_t count;
> > +
> > + /* 32-bit registers starting from CLW_DPHYCONTTX */
> > + count = reg < CLW_DPHYCONTTX_REG ? 1 : 2;
> > + *val = 0;
> > +
> > + return regmap_bulk_read(tc358746->regmap, reg, val, count);
> > +}
> > +
> > +static int
> > +tc358746_update_bits(struct tc358746 *tc358746, u32 reg, u32 mask, u32 val)
> > +{
> > + u32 tmp, orig;
> > + int err;
> > +
> > + err = tc358746_read(tc358746, reg, &orig);
> > + if (err)
> > + return err;
> > +
> > + tmp = orig & ~mask;
> > + tmp |= val & mask;
> > +
> > + return tc358746_write(tc358746, reg, tmp);
> > +}
> > +
> > +static int tc358746_set_bits(struct tc358746 *tc358746, u32 reg, u32 bits)
> > +{
> > + return tc358746_update_bits(tc358746, reg, bits, bits);
> > +}
> > +
> > +static int tc358746_clear_bits(struct tc358746 *tc358746, u32 reg, u32 bits)
> > +{
> > + return tc358746_update_bits(tc358746, reg, bits, 0);
> > +}
> > +
> > +static int tc358746_sw_reset(struct tc358746 *tc358746)
> > +{
> > + int err;
> > +
> > + err = tc358746_set_bits(tc358746, SYSCTL_REG, SRESET);
> > + if (err)
> > + return err;
> > +
> > + udelay(10);
> > +
> > + return tc358746_clear_bits(tc358746, SYSCTL_REG, SRESET);
> > +}
> > +
> > +static int
> > +tc358746_apply_pll_config(struct tc358746 *tc358746)
> > +{
> > + u8 post = tc358746->pll_post_div;
> > + u16 pre = tc358746->pll_pre_div;
> > + u16 mul = tc358746->pll_mul;
> > + u32 val, mask;
> > + int err;
> > +
> > + err = tc358746_read(tc358746, PLLCTL1_REG, &val);
> > + if (err)
> > + return err;
> > +
> > + /* Don't touch the PLL if running */
> > + if (FIELD_GET(PLL_EN, val) == 1)
> > + return 0;
> > +
> > + /* Pre-div and Multiplicator have a internal +1 logic */
> > + val = PLL_PRD(pre - 1) | PLL_FBD(mul - 1);
> > + mask = PLL_PRD_MASK | PLL_FBD_MASK;
> > + err = tc358746_update_bits(tc358746, PLLCTL0_REG, mask, val);
> > + if (err)
> > + return err;
> > +
> > + val = PLL_FRS(ilog2(post)) | RESETB | PLL_EN;
> > + mask = PLL_FRS_MASK | RESETB | PLL_EN;
> > + tc358746_update_bits(tc358746, PLLCTL1_REG, mask, val);
> > + if (err)
> > + return err;
> > +
> > + udelay(1000);
> > +
> > + return tc358746_set_bits(tc358746, PLLCTL1_REG, CKEN);
> > +}
> > +
> > +static int tc358746_apply_misc_config(struct tc358746 *tc358746)
> > +{
> > + struct device *dev = tc358746->sd.dev;
> > + const struct tc358746_format *fmt;
> > + u32 val;
> > + int err;
> > +
> > + fmt = tc358746_get_format_by_code(TC358746_SINK, tc358746->mbusfmt.code);
> > + if (IS_ERR(fmt))
> > + return PTR_ERR(fmt);
>
> mbusfmt.code is supposed to have been validated, so you can drop the
> error check here.
Yes.
> > +
> > + /* Self defined CSI user data type id's are not supported yet */
> > + val = PDFMT(fmt->pdformat);
> > + dev_dbg(dev, "DATAFMT: 0x%x\n", val);
> > + err = tc358746_write(tc358746, DATAFMT_REG, val);
> > + if (err)
> > + return err;
> > +
> > + val = PDATAF(fmt->pdataf);
> > + dev_dbg(dev, "CONFCTL[PDATAF]: 0x%x\n", fmt->pdataf);
> > + err = tc358746_update_bits(tc358746, CONFCTL_REG, PDATAF_MASK, val);
> > + if (err)
> > + return err;
> > +
> > + val = tc358746->vb_size / 32;
> > + dev_dbg(dev, "FIFOCTL: %u (0x%x)\n", val, val);
> > + err = tc358746_write(tc358746, FIFOCTL_REG, val);
> > + if (err)
> > + return err;
> > +
> > + /* Total number of bytes for each line/width */
> > + val = tc358746->mbusfmt.width * fmt->bpp / 8;
> > + dev_dbg(dev, "WORDCNT: %u (0x%x)\n", val, val);
> > + return tc358746_write(tc358746, WORDCNT_REG, val);
> > +}
> > +
> > +#ifndef MHZ
>
> Where would it be previously defined ? This sounds like asking for
> trouble later.
Sorry I don't get that, do you mean that I should define it at the very
beginning?
> > +#define MHZ (1000 * 1000)
> > +#endif
> > +
> > +/* Use MHz as base so the div needs no u64 */
> > +static u32 tc358746_cfg_to_cnt(unsigned int cfg_val,
> > + unsigned int clk_mhz,
> > + unsigned int time_base)
> > +{
> > + return DIV_ROUND_UP(cfg_val * clk_mhz, time_base);
> > +}
> > +
> > +static u32 tc358746_ps_to_cnt(unsigned int cfg_val,
> > + unsigned int clk_mhz)
> > +{
> > + return tc358746_cfg_to_cnt(cfg_val, clk_mhz, USEC_PER_SEC);
> > +}
> > +
> > +static u32 tc358746_us_to_cnt(unsigned int cfg_val,
> > + unsigned int clk_mhz)
> > +{
> > + return tc358746_cfg_to_cnt(cfg_val, clk_mhz, 1);
> > +}
> > +
> > +static int tc358746_apply_dphy_config(struct tc358746 *tc358746)
> > +{
> > + struct phy_configure_opts_mipi_dphy *cfg = &tc358746->dphy_cfg;
> > + bool non_cont_clk = !!(tc358746->csi_vep.bus.mipi_csi2.flags &
> > + V4L2_MBUS_CSI2_NONCONTINUOUS_CLOCK);
> > + struct device *dev = tc358746->sd.dev;
> > + unsigned long hs_byte_clk, hf_clk;
> > + u32 val, val2, lptxcnt;
> > + int err;
> > +
> > + /* The hs_byte_clk is also called SYSCLK in the excel sheet */
> > + hs_byte_clk = cfg->hs_clk_rate / 8;
> > + hs_byte_clk /= MHZ;
> > + hf_clk = hs_byte_clk / 2;
> > +
> > + val = tc358746_us_to_cnt(cfg->init, hf_clk) - 1;
> > + dev_dbg(dev, "LINEINITCNT: %u (0x%x)\n", val, val);
> > + err = tc358746_write(tc358746, LINEINITCNT_REG, val);
> > + if (err)
> > + return err;
> > +
> > + val = tc358746_ps_to_cnt(cfg->lpx, hs_byte_clk) - 1;
> > + lptxcnt = val;
> > + dev_dbg(dev, "LPTXTIMECNT: %u (0x%x)\n", val, val);
> > + err = tc358746_write(tc358746, LPTXTIMECNT_REG, val);
> > + if (err)
> > + return err;
> > +
> > + val = tc358746_ps_to_cnt(cfg->clk_prepare, hs_byte_clk) - 1;
> > + val2 = tc358746_ps_to_cnt(cfg->clk_zero, hs_byte_clk) - 1;
> > + dev_dbg(dev, "TCLK_PREPARECNT: %u (0x%x)\n", val, val);
> > + dev_dbg(dev, "TCLK_ZEROCNT: %u (0x%x)\n", val2, val2);
> > + dev_dbg(dev, "TCLK_HEADERCNT: 0x%x\n",
> > + (u32)(TCLK_PREPARECNT(val) | TCLK_ZEROCNT(val2)));
> > + err = tc358746_write(tc358746, TCLK_HEADERCNT_REG,
> > + TCLK_PREPARECNT(val) | TCLK_ZEROCNT(val2));
> > + if (err)
> > + return err;
> > +
> > + val = tc358746_ps_to_cnt(cfg->clk_trail, hs_byte_clk);
> > + dev_dbg(dev, "TCLK_TRAILCNT: %u (0x%x)\n", val, val);
> > + err = tc358746_write(tc358746, TCLK_TRAILCNT_REG, val);
> > + if (err)
> > + return err;
> > +
> > + val = tc358746_ps_to_cnt(cfg->hs_prepare, hs_byte_clk) - 1;
> > + val2 = tc358746_ps_to_cnt(cfg->hs_zero, hs_byte_clk) - 1;
> > + dev_dbg(dev, "THS_PREPARECNT: %u (0x%x)\n", val, val);
> > + dev_dbg(dev, "THS_ZEROCNT: %u (0x%x)\n", val2, val2);
> > + dev_dbg(dev, "THS_HEADERCNT: 0x%x\n",
> > + (u32)(THS_PREPARECNT(val) | THS_ZEROCNT(val2)));
> > + err = tc358746_write(tc358746, THS_HEADERCNT_REG,
> > + THS_PREPARECNT(val) | THS_ZEROCNT(val2));
> > + if (err)
> > + return err;
> > +
> > + /* TWAKEUP > 1ms in lptxcnt steps */
> > + val = tc358746_us_to_cnt(cfg->wakeup, hs_byte_clk);
> > + val = val / (lptxcnt + 1) - 1;
> > + dev_dbg(dev, "TWAKEUP: %u (0x%x)\n", val, val);
> > + err = tc358746_write(tc358746, TWAKEUP_REG, val);
> > + if (err)
> > + return err;
> > +
> > + val = tc358746_ps_to_cnt(cfg->clk_post, hs_byte_clk);
> > + dev_dbg(dev, "TCLK_POSTCNT: %u (0x%x)\n", val, val);
> > + err = tc358746_write(tc358746, TCLK_POSTCNT_REG, val);
> > + if (err)
> > + return err;
> > +
> > + val = tc358746_ps_to_cnt(cfg->hs_trail, hs_byte_clk);
> > + dev_dbg(dev, "THS_TRAILCNT: %u (0x%x)\n", val, val);
> > + err = tc358746_write(tc358746, THS_TRAILCNT_REG, val);
> > + if (err)
> > + return err;
> > +
> > + dev_dbg(dev, "CONTCLKMODE: %u", non_cont_clk ? 0 : 1);
> > + return tc358746_write(tc358746, TXOPTIONCNTRL_REG, non_cont_clk ? 0 : 1);
> > +}
> > +
> > +#define MAX_DATA_LANES 4
> > +
> > +static int tc358746_enable_csi_lanes(struct tc358746 *tc358746, int enable)
> > +{
> > + unsigned int lanes = tc358746->dphy_cfg.lanes;
> > + unsigned int lane;
> > + u32 reg, val;
> > + int err;
> > +
> > + err = tc358746_update_bits(tc358746, CONFCTL_REG, DATALANE_MASK,
> > + lanes - 1);
> > + if (err)
> > + return err;
> > +
> > + /* Clock lane */
> > + val = enable ? 0 : LANEDISABLE;
> > + dev_dbg(tc358746->sd.dev, "CLW_CNTRL: 0x%x\n", val);
> > + err = tc358746_write(tc358746, CLW_CNTRL_REG, val);
> > + if (err)
> > + return err;
> > +
> > + for (lane = 0; lane < MAX_DATA_LANES; lane++) {
> > + /* Data lanes */
> > + reg = D0W_CNTRL_REG + lane * 0x4;
> > + val = (enable && lane < lanes) ? 0 : LANEDISABLE;
> > +
> > + dev_dbg(tc358746->sd.dev, "D%uW_CNTRL: 0x%x\n", lane, val);
> > + err = tc358746_write(tc358746, reg, val);
> > + if (err)
> > + return err;
> > + }
> > +
> > + val = 0;
> > + if (enable) {
> > + /* Clock lane */
> > + val |= BIT(0);
> > +
> > + /* Data lanes */
> > + for (lane = 1; lane <= lanes; lane++)
> > + val |= BIT(lane);
> > + }
> > +
> > + dev_dbg(tc358746->sd.dev, "HSTXVREGEN: 0x%x\n", val);
> > + return tc358746_write(tc358746, HSTXVREGEN_REG, val);
> > +}
> > +
> > +static int tc358746_enable_csi_module(struct tc358746 *tc358746, int enable)
> > +{
> > + unsigned int lanes = tc358746->dphy_cfg.lanes;
> > + int err;
> > +
> > + /*
> > + * START and STRT are only reseted/disabled by sw reset. This is
> > + * required to put the lane state back into LP-11 state. The sw reset
> > + * don't reset register values.
> > + */
> > + if (!enable)
> > + return tc358746_sw_reset(tc358746);
> > +
> > + err = tc358746_write(tc358746, STARTCNTRL_REG, START);
> > + if (err)
> > + return err;
> > +
> > + err = tc358746_write(tc358746, CSI_START_REG, STRT);
> > + if (err)
> > + return err;
> > +
> > + /* CSI_CONTROL_REG is only indirect accessible */
> > + return tc358746_write(tc358746, CSI_CONFW_REG,
> > + MODE(MODE_SET) |
> > + ADDRESS(CSI_CONTROL_ADDRESS) |
> > + DATA(CSI_MODE | TXHSMD | NOL(lanes - 1)));
> > +}
> > +
> > +static int tc358746_enable_parallel_port(struct tc358746 *tc358746, int enable)
> > +{
> > + int err;
> > +
> > + if (enable) {
> > + err = tc358746_write(tc358746, PP_MISC_REG, 0);
> > + if (err)
> > + return err;
> > +
> > + return tc358746_set_bits(tc358746, CONFCTL_REG, PPEN);
> > + }
> > +
> > + err = tc358746_set_bits(tc358746, PP_MISC_REG, FRMSTOP);
> > + if (err)
> > + return err;
> > +
> > + err = tc358746_clear_bits(tc358746, CONFCTL_REG, PPEN);
> > + if (err)
> > + return err;
> > +
> > + return tc358746_set_bits(tc358746, PP_MISC_REG, RSTPTR);
> > +}
> > +
> > +static inline struct v4l2_subdev *tc358746_get_remote_sd(struct media_pad *pad)
> > +{
> > + pad = media_pad_remote_pad_first(pad);
> > + if (!pad)
> > + return NULL;
> > +
> > + return media_entity_to_v4l2_subdev(pad->entity);
> > +}
> > +
> > +static int tc358746_s_stream(struct v4l2_subdev *sd, int enable)
> > +{
> > + struct tc358746 *tc358746 = to_tc358746(sd);
> > + struct v4l2_subdev *src;
> > + int err;
> > +
> > + dev_dbg(sd->dev, "%sable\n", enable ? "en" : "dis");
> > +
> > + src = tc358746_get_remote_sd(&tc358746->pads[TC358746_SINK]);
> > + if (!src)
> > + return -EPIPE;
> > +
> > + if (enable) {
> > + err = pm_runtime_resume_and_get(sd->dev);
> > + if (err)
> > + return err;
> > +
> > + err = tc358746_enable_csi_lanes(tc358746, 1);
> > + if (err) {
> > + pm_runtime_mark_last_busy(sd->dev);
> > + pm_runtime_put_sync_autosuspend(sd->dev);
> > + return err;
>
> Looks like a candidate for a goto statement.
Thought about it too but than I thought about the placement of the
label and I went this way. I can change it. Should the label placed at
the end of the function or at the end of this block.
> > + }
> > +
> > + err = tc358746_enable_csi_module(tc358746, 1);
> > + if (err) {
> > + pm_runtime_mark_last_busy(sd->dev);
> > + pm_runtime_put_sync_autosuspend(sd->dev);
> > + return err;
> > + }
> > +
> > + err = tc358746_enable_parallel_port(tc358746, 1);
> > + if (err) {
> > + pm_runtime_mark_last_busy(sd->dev);
> > + pm_runtime_put_sync_autosuspend(sd->dev);
> > + return err;
> > + }
> > +
> > + err = v4l2_subdev_call(src, video, s_stream, 1);
> > + if (err) {
> > + pm_runtime_mark_last_busy(sd->dev);
> > + pm_runtime_put_sync_autosuspend(sd->dev);
> > + }
> > +
> > + return err;
> > + }
> > +
> > + /*
> > + * Lane disable trigger state change from LP-11 to LP-00
> > + * therefore it must happen before the CSI modile is disabled.
> > + */
> > + err = tc358746_enable_csi_lanes(tc358746, 0);
> > + if (err)
> > + return err;
> > +
> > + err = tc358746_enable_csi_module(tc358746, 0);
> > + if (err)
> > + return err;
> > +
> > + err = tc358746_enable_parallel_port(tc358746, 0);
> > + if (err)
> > + return err;
> > +
> > + pm_runtime_mark_last_busy(sd->dev);
> > + pm_runtime_put_sync_autosuspend(sd->dev);
> > +
> > + return v4l2_subdev_call(src, video, s_stream, 0);
> > +}
> > +
> > +static int tc358746_enum_mbus_code(struct v4l2_subdev *sd,
> > + struct v4l2_subdev_state *sd_state,
> > + struct v4l2_subdev_mbus_code_enum *code)
> > +{
> > + const struct tc358746_format *fmt;
> > +
> > + fmt = tc358746_get_format_by_idx(code->pad, code->index);
> > + if (IS_ERR(fmt))
> > + return PTR_ERR(fmt);
> > +
> > + code->code = fmt->code;
> > +
> > + return 0;
> > +}
> > +
> > +static struct v4l2_mbus_framefmt *
> > +__tc358746_get_pad_format(struct v4l2_subdev *sd,
> > + struct v4l2_subdev_state *sd_state,
> > + unsigned int pad, u32 which)
> > +{
> > + struct tc358746 *tc358746 = to_tc358746(sd);
> > +
> > + switch (which) {
> > + case V4L2_SUBDEV_FORMAT_TRY:
> > + return v4l2_subdev_get_try_format(sd, sd_state, pad);
> > + case V4L2_SUBDEV_FORMAT_ACTIVE:
> > + return &tc358746->mbusfmt;
> > + default:
> > + return NULL;
> > + }
> > +}
> > +
> > +static int tc358746_get_fmt(struct v4l2_subdev *sd,
> > + struct v4l2_subdev_state *sd_state,
> > + struct v4l2_subdev_format *format)
> > +{
> > + struct tc358746 *tc358746 = to_tc358746(sd);
> > +
> > + if (format->pad >= TC358746_NR_PADS)
> > + return -EINVAL;
> > +
> > + format->format = tc358746->mbusfmt;
> > + if (format->pad == TC358746_SOURCE)
> > + format->format.code = tc358746_src_mbus_code(tc358746->mbusfmt.code);
> > +
> > + return 0;
> > +}
> > +
> > +static int tc358746_set_fmt(struct v4l2_subdev *sd,
> > + struct v4l2_subdev_state *sd_state,
> > + struct v4l2_subdev_format *format)
> > +{
> > + struct v4l2_mbus_framefmt *mbusformat;
> > + const struct tc358746_format *fmt;
> > +
> > + if (format->pad >= TC358746_NR_PADS)
> > + return -EINVAL;
> > +
> > + /* The src follows the properties from the sink */
> > + if (format->pad == TC358746_SOURCE)
> > + return tc358746_get_fmt(sd, sd_state, format);
> > +
> > + mbusformat = __tc358746_get_pad_format(sd, sd_state, format->pad,
> > + format->which);
> > + if (!mbusformat)
> > + return -EINVAL;
> > +
> > + fmt = tc358746_get_format_by_code(format->pad, format->format.code);
> > + if (IS_ERR(fmt))
> > + fmt = tc358746_get_format_by_code(format->pad, tc358746_def_fmt.code);
> > +
> > + format->format.code = fmt->code;
> > + format->format.field = V4L2_FIELD_NONE;
> > +
> > + dev_dbg(sd->dev, "Update format: %ux%u code:0x%x -> %ux%u code:0x%x",
> > + mbusformat->width, mbusformat->height, mbusformat->code,
> > + format->format.width, format->format.height, format->format.code);
> > +
> > + *mbusformat = format->format;
> > +
> > + return 0;
> > +}
> > +
> > +static unsigned long tc358746_find_pll_settings(struct tc358746 *tc358746,
> > + unsigned long refclk,
> > + unsigned long fout)
> > +
> > +{
> > + struct device *dev = tc358746->sd.dev;
> > + unsigned long best_freq = 0;
> > + u32 min_delta = 0xffffffff;
> > + u16 prediv_max = 17;
> > + u16 prediv_min = 1;
> > + u16 m_best, mul;
> > + u16 p_best, p;
> > + u8 postdiv;
> > +
> > + if (fout > 1000 * MHZ) {
> > + dev_err(dev, "HS-Clock above 1 Ghz are not supported\n");
> > + return 0;
> > + } else if (fout >= 500 * MHZ)
> > + postdiv = 1;
> > + else if (fout >= 250 * MHZ)
> > + postdiv = 2;
> > + else if (fout >= 125 * MHZ)
> > + postdiv = 4;
> > + else
> > + postdiv = 8;
> > +
> > + for (p = prediv_min; p <= prediv_max; p++) {
> > + unsigned long delta, fin;
> > + u64 tmp;
> > +
> > + fin = DIV_ROUND_CLOSEST(refclk, p);
> > + if (fin < 4 * MHZ || fin > 40 * MHZ)
> > + continue;
> > +
> > + tmp = fout * p * postdiv;
> > + do_div(tmp, fin);
> > + mul = tmp;
> > + if (mul > 511)
> > + continue;
> > +
> > + tmp = mul * fin;
> > + do_div(tmp, p * postdiv);
> > +
> > + delta = abs(fout - tmp);
> > + if (delta < min_delta) {
> > + p_best = p;
> > + m_best = mul;
> > + min_delta = delta;
> > + best_freq = tmp;
> > + };
> > +
> > + if (delta == 0)
> > + break;
> > + };
> > +
> > + if (!best_freq) {
> > + dev_err(dev, "Failed find PLL frequency\n");
> > + return 0;
> > + }
> > +
> > + tc358746->pll_post_div = postdiv;
> > + tc358746->pll_pre_div = p_best;
> > + tc358746->pll_mul = m_best;
> > +
> > + if (best_freq != fout)
> > + dev_warn(dev, "Request PLL freq:%lu, found PLL freq:%lu\n",
> > + fout, best_freq);
> > +
> > + dev_dbg(dev, "Found PLL settings: freq:%lu prediv:%u multi:%u postdiv:%u\n",
> > + best_freq, p_best, m_best, postdiv);
> > +
> > + return best_freq;
> > +}
> > +
> > +#define TC358746_PRECISION 10
> > +
> > +static int
> > +tc358746_link_validate(struct v4l2_subdev *sd, struct media_link *link,
> > + struct v4l2_subdev_format *source_fmt,
> > + struct v4l2_subdev_format *sink_fmt)
> > +{
> > + struct tc358746 *tc358746 = to_tc358746(sd);
> > + unsigned long csi_bitrate, sensor_bitrate;
> > + const struct tc358746_format *fmt;
> > + unsigned int fifo_sz, tmp, n;
> > + s64 sensor_pclk_rate;
> > +
> > + /* Check the FIFO settings */
> > + fmt = tc358746_get_format_by_code(TC358746_SINK, tc358746->mbusfmt.code);
> > + if (IS_ERR(fmt))
> > + return PTR_ERR(fmt);
> > +
> > + sensor_pclk_rate = v4l2_ctrl_g_ctrl_int64(tc358746->sensor_pclk_ctrl);
> > + sensor_bitrate = sensor_pclk_rate * fmt->bus_width;
> > +
> > + csi_bitrate = tc358746->dphy_cfg.lanes * tc358746->pll_rate;
> > +
> > + dev_dbg(tc358746->sd.dev,
> > + "Fifo settings params: sensor-bitrate:%lu csi-bitrate:%lu",
> > + sensor_bitrate, csi_bitrate);
> > +
> > + /* Avoid possible FIFO overflows */
> > + if (csi_bitrate < sensor_bitrate) {
> > + dev_err(sd->dev,
> > + "Link validation failed csi-bitrate:%lu < sensor-bitrate:%lu\n",
> > + csi_bitrate, sensor_bitrate);
> > + return -EINVAL;
> > + }
> > +
> > + /* Best case */
> > + if (csi_bitrate == sensor_bitrate) {
> > + tc358746->vb_size = TC358746_VB_DEFAULT_SIZE;
> > + goto out;
> > + }
> > +
> > + /*
> > + * Avoid possible FIFO underflow in case of
> > + * csi_bitrate > sensor_bitrate. For such case the chip has a internal
> > + * fifo which can be used to delay the line output.
> > + *
> > + * Fifo size calculation:
> > + *
> > + * fifo-sz, image-width - in bits
> > + * sbr - sensor_bitrate in bits/s
> > + * csir - csi_bitrate in bits/s
> > + *
> > + * 1 1 1
> > + * image-width * --- + fifo-sz --- >= ---- * image-width
> > + * sbr sbr csir
> > + *
> > + * fifo-sz >= abs(sbr/csir * image-width - image-width)
> > + * `-----´
> > + * n
> > + *
> > + */
> > +
> > + sensor_bitrate /= TC358746_PRECISION;
> > + n = csi_bitrate / sensor_bitrate;
> > + tmp = (tc358746->mbusfmt.width * TC358746_PRECISION) / n;
> > + fifo_sz = tc358746->mbusfmt.width - tmp;
> > + fifo_sz *= fmt->bpp;
> > + tc358746->vb_size = round_up(fifo_sz, 32);
> > +
>
> Please also call v4l2_subdev_link_validate_default() here.
Did it in my internal prepared v2 ^^ I call it now at the very
beginning of this function.
> I wonder if the above calculation wouldn't be better performed in
> .s_stream() (or rather in a function being called by .s_stream()) when
> enabling streaming.
No I wouldn't shift that, since the link validation is in IMHO the
correct place to inform the user that the pipeline can't negotiate if
the fifo can't be configured correctly. Therefore I placed it here.
> > +out:
> > + dev_dbg(tc358746->sd.dev,
> > + "Found FIFO size[bits]:%u -> aligned to size[bits]:%u\n",
> > + fifo_sz, tc358746->vb_size);
> > +
> > + return tc358746->vb_size > TC358746_VB_MAX_SIZE ? -EINVAL : 0;
> > +}
> > +
> > +static int tc358746_get_mbus_config(struct v4l2_subdev *sd, unsigned int pad,
> > + struct v4l2_mbus_config *config)
> > +{
> > + struct tc358746 *tc358746 = to_tc358746(sd);
> > +
> > + if (pad != TC358746_SOURCE)
> > + return -EINVAL;
> > +
> > + config->type = V4L2_MBUS_CSI2_DPHY;
> > + config->bus.mipi_csi2 = tc358746->csi_vep.bus.mipi_csi2;
> > +
> > + return 0;
> > +}
> > +
> > +static int tc358746_link_setup(struct media_entity *entity,
> > + const struct media_pad *local,
> > + const struct media_pad *remote, u32 flags)
> > +{
> > + struct v4l2_subdev *sd = media_entity_to_v4l2_subdev(entity);
> > + struct v4l2_subdev *sensor_sd =
> > + media_entity_to_v4l2_subdev(remote->entity);
> > + struct tc358746 *tc358746 = to_tc358746(sd);
> > + struct device *dev = sd->dev;
> > + struct v4l2_ctrl *ctrl;
> > +
> > + /* no special requirements on source pads */
> > + if (local->flags & MEDIA_PAD_FL_SOURCE)
> > + return 0;
> > +
> > + dev_dbg(dev, "link setup '%s':%d->'%s':%d[%d]",
> > + remote->entity->name, remote->index, local->entity->name,
> > + local->index, flags & MEDIA_LNK_FL_ENABLED);
> > +
> > + /* Required for the fifo calculation */
> > + ctrl = v4l2_ctrl_find(sensor_sd->ctrl_handler, V4L2_CID_PIXEL_RATE);
> > + if (!ctrl) {
> > + dev_err(dev, "Subdev [%s] must support V4L2_CID_PIXEL_RATE\n",
> > + sensor_sd->name);
> > + return -EINVAL;
> > + }
> > + tc358746->sensor_pclk_ctrl = ctrl;
> > +
> > + return 0;
> > +}
> > +
> > +int __maybe_unused
> > +tc358746_g_register(struct v4l2_subdev *sd, struct v4l2_dbg_register *reg)
> > +{
> > + struct tc358746 *tc358746 = to_tc358746(sd);
> > +
> > + /* 32-bit registers starting from CLW_DPHYCONTTX */
> > + reg->size = reg->reg < CLW_DPHYCONTTX_REG ? 2 : 4;
> > +
> > + if (pm_runtime_resume_and_get(sd->dev)) {
> > + dev_err(sd->dev, "Failed to resume the device\n");
> > + return 0;
> > + }
> > +
> > + tc358746_read(tc358746, reg->reg, (u32 *)®->val);
> > +
> > + pm_runtime_mark_last_busy(sd->dev);
> > + pm_runtime_put_sync_autosuspend(sd->dev);
> > +
> > + return 0;
> > +}
> > +
> > +int __maybe_unused
> > +tc358746_s_register(struct v4l2_subdev *sd, const struct v4l2_dbg_register *reg)
> > +{
> > + struct tc358746 *tc358746 = to_tc358746(sd);
> > +
> > + if (pm_runtime_resume_and_get(sd->dev)) {
> > + dev_err(sd->dev, "Failed to resume the device\n");
> > + return 0;
> > + }
> > +
> > + tc358746_write(tc358746, (u32)reg->reg, (u32)reg->val);
> > +
> > + pm_runtime_mark_last_busy(sd->dev);
> > + pm_runtime_put_sync_autosuspend(sd->dev);
> > +
> > + return 0;
> > +}
> > +
> > +static const struct v4l2_subdev_core_ops tc358746_core_ops = {
> > +#ifdef CONFIG_VIDEO_ADV_DEBUG
> > + .g_register = tc358746_g_register,
> > + .s_register = tc358746_s_register,
> > +#endif
>
> Have you found this to be useful ?
It's useful since the regmap usage, because some registers are 32bit
wide and some 16bit wide... Those functions abstract it and I can set
values :) which is not allowed by the regmap debug interface. So yes,
it's not that bad..
> > +};
> > +
> > +static const struct v4l2_subdev_video_ops tc358746_video_ops = {
> > + .s_stream = tc358746_s_stream,
> > +};
> > +
> > +static const struct v4l2_subdev_pad_ops tc358746_pad_ops = {
> > + .enum_mbus_code = tc358746_enum_mbus_code,
> > + .set_fmt = tc358746_set_fmt,
> > + .get_fmt = tc358746_get_fmt,
> > + .link_validate = tc358746_link_validate,
> > + .get_mbus_config = tc358746_get_mbus_config,
> > +};
> > +
> > +static const struct v4l2_subdev_ops tc358746_ops = {
> > + .core = &tc358746_core_ops,
> > + .video = &tc358746_video_ops,
> > + .pad = &tc358746_pad_ops,
> > +};
> > +
> > +static const struct media_entity_operations tc358746_entity_ops = {
> > + .get_fwnode_pad = v4l2_subdev_get_fwnode_pad_1_to_1,
> > + .link_setup = tc358746_link_setup,
> > + .link_validate = v4l2_subdev_link_validate,
> > +};
> > +
> > +static int tc358746_mclk_enable(struct clk_hw *hw)
> > +{
> > + struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
> > + unsigned int div;
> > + u32 val;
> > + int err;
> > +
> > + div = tc358746->mclk_postdiv / 2;
> > + val = MCLK_HIGH(div - 1) | MCLK_LOW(div - 1);
> > + dev_dbg(tc358746->sd.dev, "MCLKCTL: %u (0x%x)\n", val, val);
> > + err = tc358746_write(tc358746, MCLKCTL_REG, val);
> > + if (err)
> > + return err;
> > +
> > + if (tc358746->mclk_prediv == 8)
> > + val = MCLKDIV(MCLKDIV_8);
> > + else if (tc358746->mclk_prediv == 4)
> > + val = MCLKDIV(MCLKDIV_4);
> > + else
> > + val = MCLKDIV(MCLKDIV_2);
> > +
> > + dev_dbg(tc358746->sd.dev, "CLKCTL[MCLKDIV]: %u (0x%x)\n", val, val);
> > + return tc358746_update_bits(tc358746, CLKCTL_REG, MCLKDIV_MASK, val);
> > +}
> > +
> > +static void tc358746_mclk_disable(struct clk_hw *hw)
> > +{
> > + struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
> > +
> > + tc358746_write(tc358746, MCLKCTL_REG, 0);
> > +}
> > +
> > +static long
> > +tc358746_find_mclk_settings(struct tc358746 *tc358746, unsigned long mclk_rate)
> > +{
> > + unsigned long pll_rate = tc358746->pll_rate;
> > + const unsigned char prediv[] = { 2, 4, 8 };
> > + unsigned int mclk_prediv, mclk_postdiv;
> > + struct device *dev = tc358746->sd.dev;
> > + unsigned int postdiv, mclkdiv;
> > + unsigned long best_mclk_rate;
> > + unsigned int i;
> > +
> > + /*
> > + * MCLK-Div
> > + * -------------------´`---------------------
> > + * ´ `
> > + * +-------------+ +------------------------+
> > + * | MCLK-PreDiv | | MCLK-PostDiv |
> > + * PLL --> | (2/4/8) | --> | (mclk_low + mclk_high) | --> MCLK
> > + * +-------------+ +------------------------+
> > + *
> > + * The register value of mclk_low/high is mclk_low/high+1, i.e.:
> > + * mclk_low/high = 1 --> 2 MCLK-Ref Counts
> > + * mclk_low/high = 255 --> 256 MCLK-Ref Counts == max.
> > + * If mclk_low and mclk_high are 0 then MCLK is disabled.
> > + *
> > + * Keep it simple and support 50/50 duty cycles only for now,
> > + * so the calc will be:
> > + *
> > + * MCLK = PLL / (MCLK-PreDiv * 2 * MCLK-PostDiv)
> > + */
> > +
> > + if (mclk_rate == tc358746->mclk_rate)
> > + return mclk_rate;
> > +
> > + /* Highest possible rate */
> > + mclkdiv = pll_rate / mclk_rate;
> > + if (mclkdiv <= 8) {
> > + mclk_prediv = 2;
> > + mclk_postdiv = 4;
> > + best_mclk_rate = pll_rate / (2 * 4);
> > + goto out;
> > + }
> > +
> > + /* First check the prediv */
> > + for (i = 0; i < ARRAY_SIZE(prediv); i++) {
> > + postdiv = mclkdiv / prediv[i];
> > +
> > + if (postdiv % 2)
> > + continue;
> > +
> > + if (postdiv >= 4 && postdiv <= 512) {
> > + mclk_prediv = prediv[i];
> > + mclk_postdiv = postdiv;
> > + best_mclk_rate = pll_rate / (prediv[i] * postdiv);
> > + goto out;
> > + }
> > + }
> > +
> > + /* No suitable prediv found, so try to adjust the postdiv */
> > + for (postdiv = 4; postdiv <= 512; postdiv += 2) {
> > + unsigned int pre;
> > +
> > + pre = mclkdiv / postdiv;
> > + if (pre == 2 || pre == 4 || pre == 8) {
> > + mclk_prediv = pre;
> > + mclk_postdiv = postdiv;
> > + best_mclk_rate = pll_rate / (pre * postdiv);
> > + goto out;
> > + }
> > + }
> > +
> > + /* The MCLK <-> PLL gap is to high -> use largest possible div */
> > + mclk_prediv = 8;
> > + mclk_postdiv = 512;
> > + best_mclk_rate = pll_rate / (8 * 512);
> > +
> > +out:
> > + tc358746->mclk_prediv = mclk_prediv;
> > + tc358746->mclk_postdiv = mclk_postdiv;
> > + tc358746->mclk_rate = best_mclk_rate;
> > +
> > + if (best_mclk_rate != mclk_rate)
> > + dev_warn(dev, "Request MCLK freq:%lu, found MCLK freq:%lu\n",
> > + mclk_rate, best_mclk_rate);
> > +
> > + dev_dbg(dev, "Found MCLK settings: freq:%lu prediv:%u postdiv:%u\n",
> > + best_mclk_rate, mclk_prediv, mclk_postdiv);
> > +
> > + return best_mclk_rate;
> > +}
> > +
> > +unsigned long tc358746_recalc_rate(struct clk_hw *hw, unsigned long parent_rate)
> > +{
> > + struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
> > + unsigned int prediv, postdiv;
> > + u32 val;
> > + int err;
> > +
> > + err = tc358746_read(tc358746, MCLKCTL_REG, &val);
> > + if (err)
> > + return 0;
> > +
> > + postdiv = FIELD_GET(MCLK_LOW_MASK, val) + 1;
> > + postdiv += FIELD_GET(MCLK_HIGH_MASK, val) + 1;
> > +
> > + err = tc358746_read(tc358746, CLKCTL_REG, &val);
> > + if (err)
> > + return 0;
> > +
> > + prediv = FIELD_GET(MCLKDIV_MASK, val);
> > + if (prediv == MCLKDIV_8)
> > + prediv = 8;
> > + else if (prediv == MCLKDIV_4)
> > + prediv = 4;
> > + else
> > + prediv = 2;
> > +
> > + return tc358746->pll_rate / (prediv * postdiv);
> > +}
> > +
> > +static long tc358746_mclk_round_rate(struct clk_hw *hw, unsigned long rate,
> > + unsigned long *parent_rate)
> > +{
> > + struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
> > +
> > + *parent_rate = tc358746->pll_rate;
> > +
> > + return tc358746_find_mclk_settings(tc358746, rate);
> > +}
> > +
> > +static int tc358746_mclk_set_rate(struct clk_hw *hw, unsigned long rate,
> > + unsigned long parent_rate)
> > +{
> > + struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
> > +
> > + tc358746_find_mclk_settings(tc358746, rate);
> > +
> > + return tc358746_mclk_enable(hw);
> > +}
> > +
> > +static const struct clk_ops tc358746_mclk_ops = {
> > + .enable = tc358746_mclk_enable,
> > + .disable = tc358746_mclk_disable,
> > + .recalc_rate = tc358746_recalc_rate,
> > + .round_rate = tc358746_mclk_round_rate,
> > + .set_rate = tc358746_mclk_set_rate,
> > +};
> > +
> > +static int tc358746_notify_bound(struct v4l2_async_notifier *notifier,
> > + struct v4l2_subdev *sd,
> > + struct v4l2_async_subdev *asd)
> > +{
> > + struct tc358746 *tc358746 =
> > + container_of(notifier, struct tc358746, notifier);
> > + struct media_pad *sink = &tc358746->pads[TC358746_SINK];
> > +
> > + return v4l2_create_fwnode_links_to_pad(sd, sink, MEDIA_LNK_FL_ENABLED);
> > +}
> > +
> > +static const struct v4l2_async_notifier_operations tc358746_notify_ops = {
> > + .bound = tc358746_notify_bound,
> > +};
> > +
> > +static int tc358746_async_register(struct tc358746 *tc358746)
> > +{
> > + struct v4l2_fwnode_endpoint vep = {
> > + .bus_type = V4L2_MBUS_PARALLEL,
> > + };
> > + struct v4l2_async_subdev *asd;
> > + struct fwnode_handle *ep;
> > + int err;
> > +
> > + ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(tc358746->sd.dev),
> > + TC358746_SINK, 0, 0);
> > + if (!ep)
> > + return -ENOTCONN;
> > +
> > + err = v4l2_fwnode_endpoint_parse(ep, &vep);
> > + if (err) {
> > + fwnode_handle_put(ep);
> > + return err;
> > + }
> > +
> > + v4l2_async_nf_init(&tc358746->notifier);
> > + asd = v4l2_async_nf_add_fwnode_remote(&tc358746->notifier, ep,
> > + struct v4l2_async_subdev);
> > + if (IS_ERR(asd)) {
> > + fwnode_handle_put(ep);
> > + return PTR_ERR(asd);
> > + }
> > +
> > + fwnode_handle_put(ep);
> > +
> > + tc358746->notifier.ops = &tc358746_notify_ops;
> > +
> > + err = v4l2_async_subdev_nf_register(&tc358746->sd, &tc358746->notifier);
> > + if (err) {
> > + v4l2_async_nf_cleanup(&tc358746->notifier);
> > + return err;
> > + }
> > +
> > + tc358746->sd.fwnode = fwnode_graph_get_endpoint_by_id(
> > + dev_fwnode(tc358746->sd.dev), TC358746_SOURCE, 0, 0);
> > +
> > + err = v4l2_async_register_subdev(&tc358746->sd);
> > + if (err) {
> > + v4l2_async_nf_unregister(&tc358746->notifier);
> > + v4l2_async_nf_cleanup(&tc358746->notifier);
> > + }
> > +
> > + return err;
> > +}
> > +
> > +static int tc358746_probe(struct i2c_client *client)
> > +{
> > + struct clk_init_data mclk_initdata = { };
> > + struct device *dev = &client->dev;
> > + struct v4l2_fwnode_endpoint *vep;
> > + unsigned long csi_link_rate;
> > + struct tc358746 *tc358746;
> > + struct fwnode_handle *ep;
> > + unsigned char csi_lanes;
> > + struct v4l2_subdev *sd;
> > + struct v4l2_ctrl *ctrl;
> > + unsigned long refclk;
> > + unsigned int i;
> > + int err;
> > + u32 val;
> > +
> > + tc358746 = devm_kzalloc(&client->dev, sizeof(*tc358746), GFP_KERNEL);
> > + if (!tc358746)
> > + return -ENOMEM;
> > +
> > + tc358746->regmap = devm_regmap_init_i2c(client, &tc358746_regmap_config);
> > + if (IS_ERR(tc358746->regmap))
> > + return dev_err_probe(dev, PTR_ERR(tc358746->regmap),
> > + "Failed to init regmap\n");
> > +
> > + tc358746->refclk = devm_clk_get(dev, "refclk");
> > + if (IS_ERR(tc358746->refclk))
> > + return dev_err_probe(dev, PTR_ERR(tc358746->refclk),
> > + "Failed to get refclk\n");
> > +
> > + err = clk_prepare_enable(tc358746->refclk);
> > + if (err)
> > + return dev_err_probe(dev, err,
> > + "Failed to enable refclk\n");
> > +
> > + refclk = clk_get_rate(tc358746->refclk);
> > + clk_disable_unprepare(tc358746->refclk);
> > +
> > + if (refclk < 6 * MHZ || refclk > 40 * MHZ)
> > + return dev_err_probe(dev, -EINVAL, "Invalid refclk range\n");
> > +
> > + for (i = 0; i < ARRAY_SIZE(tc358746_supplies); i++)
> > + tc358746->supplies[i].supply = tc358746_supplies[i];
> > +
> > + err = devm_regulator_bulk_get(dev, ARRAY_SIZE(tc358746_supplies),
> > + tc358746->supplies);
> > + if (err)
> > + return dev_err_probe(dev, err, "Failed to get supplies\n");
> > +
> > + tc358746->reset_gpio = devm_gpiod_get_optional(dev, "reset",
> > + GPIOD_OUT_HIGH);
> > + if (IS_ERR(tc358746->reset_gpio))
> > + return dev_err_probe(dev, PTR_ERR(tc358746->reset_gpio),
> > + "Failed to get reset-gpios\n");
> > +
> > + sd = &tc358746->sd;
> > + v4l2_i2c_subdev_init(sd, client, &tc358746_ops);
> > + sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
> > + sd->entity.function = MEDIA_ENT_F_VID_IF_BRIDGE;
> > + sd->entity.ops = &tc358746_entity_ops;
> > +
> > + tc358746->pads[TC358746_SINK].flags = MEDIA_PAD_FL_SINK;
> > + tc358746->pads[TC358746_SOURCE].flags = MEDIA_PAD_FL_SOURCE;
> > + err = media_entity_pads_init(&sd->entity, TC358746_NR_PADS,
> > + tc358746->pads);
> > + if (err)
> > + return dev_err_probe(dev, err,
> > + "Failed to setup media-entity pads\n");
> > +
> > + ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(dev), TC358746_SOURCE,
> > + 0, 0);
> > + if (!ep) {
> > + dev_err(dev, "Missing endpoint node\n");
> > + err = -EINVAL;
> > + goto err_mc;
> > + }
> > +
> > + /* Currently we only support 'parallel in' -> 'csi out' */
> > + vep = &tc358746->csi_vep;
> > + vep->bus_type = V4L2_MBUS_CSI2_DPHY;
> > + err = v4l2_fwnode_endpoint_alloc_parse(ep, vep);
> > + fwnode_handle_put(ep);
> > + if (err) {
> > + dev_err(dev, "Failed to parse source endpoint\n");
> > + goto err_mc;
> > + }
> > +
> > + csi_lanes = vep->bus.mipi_csi2.num_data_lanes;
> > + if (csi_lanes == 0 || csi_lanes > 4 ||
> > + vep->nr_of_link_frequencies == 0) {
> > + dev_err(dev, "error: Invalid CSI-2 settings\n");
> > + err = -EINVAL;
> > + goto err_vep;
> > + }
> > +
> > + /* TODO: Add support to handle multiple link frequencies */
> > + csi_link_rate = (unsigned long)vep->link_frequencies[0];
> > + tc358746->pll_rate = tc358746_find_pll_settings(tc358746, refclk,
> > + csi_link_rate * 2);
> > + if (!tc358746->pll_rate) {
> > + err = -EINVAL;
> > + goto err_vep;
> > + }
> > +
> > + err = phy_mipi_dphy_get_default_config_for_hsclk(tc358746->pll_rate,
> > + csi_lanes,
> > + &tc358746->dphy_cfg);
> > + if (err)
> > + goto err_vep;
> > +
> > + tc358746->mbusfmt = tc358746_def_fmt;
> > + tc358746->vb_size = TC358746_VB_DEFAULT_SIZE;
> > +
> > + dev_set_drvdata(dev, tc358746);
> > + pm_runtime_set_autosuspend_delay(dev, 200);
> > + pm_runtime_use_autosuspend(dev);
> > + pm_runtime_enable(dev);
> > +
> > + err = pm_runtime_resume_and_get(dev);
> > + if (err < 0) {
> > + dev_err(dev, "Failed to resume the device\n");
> > + goto err_vep;
> > + }
> > +
> > + /* Ensure that CSI interface is put into LP-11 state */
> > + err = tc358746_sw_reset(tc358746);
> > + if (err) {
> > + pm_runtime_put_noidle(dev);
> > + dev_err(dev, "Failed to reset the device\n");
> > + goto err_pm;
> > + }
> > +
> > + err = tc358746_read(tc358746, CHIPID_REG, &val);
> > + pm_runtime_mark_last_busy(dev);
> > + pm_runtime_put_sync_autosuspend(dev);
> > + if (err) {
> > + dev_err(dev, "Failed to read chipid\n");
> > + err = -ENODEV;
> > + goto err_pm;
> > + }
> > +
> > + if (FIELD_GET(CHIPID, val) != 0x44) {
> > + dev_err(dev, "Invalid chipid 0x%02x\n",
> > + (u32)FIELD_GET(CHIPID, val));
> > + err = -ENODEV;
> > + goto err_pm;
> > + }
> > +
> > + /* Optional MCLK provider support */
> > + if (device_property_present(dev, "#clock-cells")) {
> > + const char *mclk_name;
> > +
> > + /* Init to highest possibel MCLK */
> > + tc358746->mclk_postdiv = 512;
> > + tc358746->mclk_prediv = 8;
> > +
> > + mclk_name = "tc358746-mclk";
> > + device_property_read_string(dev, "clock-output-names",
> > + &mclk_name);
> > +
> > + mclk_initdata.name = mclk_name;
> > + mclk_initdata.ops = &tc358746_mclk_ops;
> > + tc358746->mclk_hw.init = &mclk_initdata;
> > +
> > + err = devm_clk_hw_register(dev, &tc358746->mclk_hw);
> > + if (err) {
> > + dev_err(dev, "Failed to register mclk provider\n");
> > + goto err_pm;
> > + }
> > +
> > + err = devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get,
> > + &tc358746->mclk_hw);
> > + if (err) {
> > + dev_err(dev, "Failed to add mclk provider\n");
> > + goto err_pm;
> > + }
> > + }
> > +
> > + v4l2_ctrl_handler_init(&tc358746->ctrl_hdl, 1);
> > +
> > + ctrl = v4l2_ctrl_new_int_menu(&tc358746->ctrl_hdl, NULL,
> > + V4L2_CID_LINK_FREQ, 0, 0,
> > + vep->link_frequencies);
> > + if (ctrl)
> > + ctrl->flags |= V4L2_CTRL_FLAG_READ_ONLY;
> > +
> > + tc358746->sd.ctrl_handler = &tc358746->ctrl_hdl;
> > + if (tc358746->ctrl_hdl.error) {
> > + err = tc358746->ctrl_hdl.error;
> > + goto err_pm;
> > + }
> > +
> > + v4l2_ctrl_handler_setup(&tc358746->ctrl_hdl);
> > +
> > + err = tc358746_async_register(tc358746);
> > + if (err < 0)
> > + goto err_ctrl;
> > +
> > + dev_info(dev, "%s found @ 0x%x (%s)\n", client->name,
> > + client->addr, client->adapter->name);
>
> I'd skip this to avoid adding noise to the kernel log at boot time. I
> would also probably split some of the code out of the probe function as
> it's fairly large. Up to you.
Yes it is large but most of it is just requesting stuff and so..
Therefore I kept it here since I don't need it elsewhere. What about
setting it to dev_dbg()? Sometimes it can be useful e.g. to find the
problem why /dev/media is not comming up..
> > +
> > + return 0;
> > +
> > +err_ctrl:
> > + v4l2_ctrl_handler_free(&tc358746->ctrl_hdl);
> > +err_pm:
> > + pm_runtime_disable(dev);
> > + pm_runtime_set_suspended(dev);
> > + pm_runtime_dont_use_autosuspend(dev);
> > +err_vep:
> > + v4l2_fwnode_endpoint_free(vep);
> > +err_mc:
> > + media_entity_cleanup(&sd->entity);
> > +
> > + return err;
> > +}
> > +
> > +static int tc358746_remove(struct i2c_client *client)
> > +{
> > + struct v4l2_subdev *sd = i2c_get_clientdata(client);
> > + struct tc358746 *tc358746 = to_tc358746(sd);
> > +
> > + v4l2_ctrl_handler_free(&tc358746->ctrl_hdl);
> > + v4l2_fwnode_endpoint_free(&tc358746->csi_vep);
> > + v4l2_async_nf_unregister(&tc358746->notifier);
> > + v4l2_async_nf_cleanup(&tc358746->notifier);
> > + v4l2_async_unregister_subdev(sd);
> > + v4l2_device_unregister_subdev(sd);
>
> This shouldn't be needed v4l2_async_unregister_subdev() should be
> enough.
Okay, thanks. There are a lot of unregister helpers in the v4l2 space..
>
> > + media_entity_cleanup(&sd->entity);
> > +
> > + pm_runtime_disable(sd->dev);
> > + pm_runtime_set_suspended(sd->dev);
> > + pm_runtime_dont_use_autosuspend(sd->dev);
> > +
> > + return 0;
> > +}
> > +
> > +static int tc358746_suspend(struct device *dev)
> > +{
> > + struct tc358746 *tc358746 = dev_get_drvdata(dev);
> > +
> > + clk_disable_unprepare(tc358746->refclk);
> > +
> > + return regulator_bulk_disable(ARRAY_SIZE(tc358746_supplies),
> > + tc358746->supplies);
>
> Shouldn't you reenable the clock if this fails ?
Hm.. if this fails I could end in a undefined chip state. But I got the
point that the framework would be in a bad state if it tries again to
suspend the device.
> > +}
> > +
> > +static int tc358746_resume(struct device *dev)
> > +{
> > + struct tc358746 *tc358746 = dev_get_drvdata(dev);
> > + int err;
> > +
> > + gpiod_set_value(tc358746->reset_gpio, 1);
> > +
> > + err = regulator_bulk_enable(ARRAY_SIZE(tc358746_supplies),
> > + tc358746->supplies);
> > + if (err)
> > + return err;
> > +
> > + /* min. 200ns */
> > + usleep_range(10, 20);
> > +
> > + gpiod_set_value(tc358746->reset_gpio, 0);
> > +
> > + err = clk_prepare_enable(tc358746->refclk);
> > + if (err)
> > + return err;
>
> The regulators need to be disabled in case of failure here and below
> (and so does the clock below).
Yes, you're right.
> > +
> > + /* min. 700us ... 1ms */
> > + usleep_range(1000, 1500);
> > +
> > + /* Sync state */
> > + err = tc358746_apply_pll_config(tc358746);
> > + if (err)
> > + return err;
> > +
> > + err = tc358746_apply_dphy_config(tc358746);
> > + if (err)
> > + return err;
> > +
> > + return tc358746_apply_misc_config(tc358746);
>
> Does all this belong to the PM resume handler ? It seems configuration
> could be handled in .s_stream() instead.
This gets called by the s_stream() during getting the power state but I
can move the dphy/misc_config to the .s_stream() of course. The pll
needs to be there since the device can be a clock provider e.g. for the
sensor.
Thanks for the review :)
Regards,
Marco
> > +}
> > +
> > +DEFINE_RUNTIME_DEV_PM_OPS(tc358746_pm_ops, tc358746_suspend,
> > + tc358746_resume, NULL);
> > +
> > +static const struct of_device_id __maybe_unused tc358746_of_match[] = {
> > + { .compatible = "toshiba,tc358746" },
> > + { },
> > +};
> > +MODULE_DEVICE_TABLE(of, tc358746_of_match);
> > +
> > +static struct i2c_driver tc358746_driver = {
> > + .driver = {
> > + .name = "tc358746",
> > + .pm = pm_ptr(&tc358746_pm_ops),
> > + .of_match_table = tc358746_of_match,
> > + },
> > + .probe_new = tc358746_probe,
> > + .remove = tc358746_remove,
> > +};
> > +
> > +module_i2c_driver(tc358746_driver);
> > +
> > +MODULE_DESCRIPTION("Toshiba TC358746 Parallel to CSI-2 bridge driver");
> > +MODULE_AUTHOR("Marco Felsch <kernel@pengutronix.de>");
> > +MODULE_LICENSE("GPL");
>
> --
> Regards,
>
> Laurent Pinchart
>
^ permalink raw reply [flat|nested] 34+ messages in thread
* Re: [PATCH 4/4] media: tc358746: add Toshiba TC358746 Parallel to CSI-2 bridge driver
@ 2022-09-15 16:54 ` Marco Felsch
0 siblings, 0 replies; 34+ messages in thread
From: Marco Felsch @ 2022-09-15 16:54 UTC (permalink / raw)
To: Laurent Pinchart
Cc: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, linux-kernel, linux-phy,
devicetree, linux-media, kernel
Hi Laurent,
On 22-09-05, Laurent Pinchart wrote:
> Hi Marco,
>
> Thank you for the patch.
>
> On Thu, Aug 18, 2022 at 04:33:07PM +0200, Marco Felsch wrote:
> > Adding support for the TC358746 parallel <-> MIPI CSI bridge. This chip
> > supports two operating modes:
> > 1st) parallel-in -> mipi-csi out
> > 2nd) mipi-csi in -> parallel out
> >
> > This patch only adds the support for the 1st mode.
> >
> > Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
> > ---
> > drivers/media/i2c/Kconfig | 17 +
> > drivers/media/i2c/Makefile | 1 +
> > drivers/media/i2c/tc358746.c | 1645 ++++++++++++++++++++++++++++++++++
> > 3 files changed, 1663 insertions(+)
> > create mode 100644 drivers/media/i2c/tc358746.c
> >
> > diff --git a/drivers/media/i2c/Kconfig b/drivers/media/i2c/Kconfig
> > index 7806d4b81716..aefb9c9e0c08 100644
> > --- a/drivers/media/i2c/Kconfig
> > +++ b/drivers/media/i2c/Kconfig
> > @@ -1272,6 +1272,23 @@ config VIDEO_TC358743_CEC
> > When selected the tc358743 will support the optional
> > HDMI CEC feature.
> >
> > +config VIDEO_TC358746
> > + tristate "Toshiba TC358746 parallel-CSI2 bridge"
> > + depends on VIDEO_DEV && I2C
> > + select VIDEO_V4L2_SUBDEV_API
> > + select MEDIA_CONTROLLER
> > + select V4L2_FWNODE
> > + select GENERIC_PHY_MIPI_DPHY
> > + select REGMAP_I2C
> > + select COMMON_CLK
> > + help
> > + Support for the Toshiba TC358746 parallel to MIPI CSI-2 bridge.
> > + The bridge can work in both directions but currently only the
> > + parallel-in / csi-out path is supported.
> > +
> > + To compile this driver as a module, choose M here: the
> > + module will be called tc358746.
> > +
> > config VIDEO_TVP514X
> > tristate "Texas Instruments TVP514x video decoder"
> > depends on VIDEO_DEV && I2C
> > diff --git a/drivers/media/i2c/Makefile b/drivers/media/i2c/Makefile
> > index 0a2933103dd9..d1096c2ab480 100644
> > --- a/drivers/media/i2c/Makefile
> > +++ b/drivers/media/i2c/Makefile
> > @@ -118,6 +118,7 @@ obj-$(CONFIG_VIDEO_SONY_BTF_MPX) += sony-btf-mpx.o
> > obj-$(CONFIG_VIDEO_SR030PC30) += sr030pc30.o
> > obj-$(CONFIG_VIDEO_ST_MIPID02) += st-mipid02.o
> > obj-$(CONFIG_VIDEO_TC358743) += tc358743.o
> > +obj-$(CONFIG_VIDEO_TC358746) += tc358746.o
> > obj-$(CONFIG_VIDEO_TDA1997X) += tda1997x.o
> > obj-$(CONFIG_VIDEO_TDA7432) += tda7432.o
> > obj-$(CONFIG_VIDEO_TDA9840) += tda9840.o
> > diff --git a/drivers/media/i2c/tc358746.c b/drivers/media/i2c/tc358746.c
> > new file mode 100644
> > index 000000000000..7b71d0cf72a9
> > --- /dev/null
> > +++ b/drivers/media/i2c/tc358746.c
> > @@ -0,0 +1,1645 @@
> > +// SPDX-License-Identifier: GPL-2.0-only
> > +/*
> > + * TC358746 - Parallel <-> CSI-2 Bridge
> > + *
> > + * Copyright 2022 Marco Felsch <kernel@pengutronix.de>
> > + *
> > + * Notes:
> > + * - Currently only 'Parallel-in -> CSI-out' mode is supported!
> > + */
> > +
> > +#include <linux/bitfield.h>
> > +#include <linux/clk.h>
> > +#include <linux/clk-provider.h>
> > +#include <linux/delay.h>
> > +#include <linux/i2c.h>
> > +#include <linux/interrupt.h>
> > +#include <linux/kernel.h>
> > +#include <linux/module.h>
> > +#include <linux/phy/phy-mipi-dphy.h>
> > +#include <linux/property.h>
> > +#include <linux/pm_runtime.h>
> > +#include <linux/regmap.h>
> > +#include <media/v4l2-ctrls.h>
> > +#include <media/v4l2-device.h>
> > +#include <media/v4l2-fwnode.h>
> > +#include <media/v4l2-mc.h>
> > +
> > +/* 16-bit registers */
> > +#define CHIPID_REG 0x0000
> > +#define CHIPID GENMASK(15, 8)
> > +
> > +#define SYSCTL_REG 0x0002
> > +#define SRESET BIT(0)
> > +
> > +#define CONFCTL_REG 0x0004
> > +#define PDATAF_MASK GENMASK(9, 8)
> > +#define PDATAF_MODE0 0
> > +#define PDATAF_MODE1 1
> > +#define PDATAF_MODE2 2
> > +#define PDATAF(val) FIELD_PREP(PDATAF_MASK, (val))
> > +#define PPEN BIT(6)
> > +#define DATALANE_MASK GENMASK(1, 0)
> > +
> > +#define FIFOCTL_REG 0x0006
> > +#define DATAFMT_REG 0x0008
> > +#define PDFMT(val) FIELD_PREP(GENMASK(7, 4), (val))
> > +
> > +#define MCLKCTL_REG 0x000c
> > +#define MCLK_HIGH_MASK GENMASK(15, 8)
> > +#define MCLK_LOW_MASK GENMASK(7, 0)
> > +#define MCLK_HIGH(val) FIELD_PREP(MCLK_HIGH_MASK, (val))
> > +#define MCLK_LOW(val) FIELD_PREP(MCLK_LOW_MASK, (val))
> > +
> > +#define PLLCTL0_REG 0x0016
> > +#define PLL_PRD_MASK GENMASK(15, 12)
> > +#define PLL_PRD(val) FIELD_PREP(PLL_PRD_MASK, (val))
> > +#define PLL_FBD_MASK GENMASK(8, 0)
> > +#define PLL_FBD(val) FIELD_PREP(PLL_FBD_MASK, (val))
> > +
> > +#define PLLCTL1_REG 0x0018
> > +#define PLL_FRS_MASK GENMASK(11, 10)
> > +#define PLL_FRS(val) FIELD_PREP(PLL_FRS_MASK, (val))
> > +#define CKEN BIT(4)
> > +#define RESETB BIT(1)
> > +#define PLL_EN BIT(0)
> > +
> > +#define CLKCTL_REG 0x0020
> > +#define MCLKDIV_MASK GENMASK(3, 2)
> > +#define MCLKDIV(val) FIELD_PREP(MCLKDIV_MASK, (val))
> > +#define MCLKDIV_8 0
> > +#define MCLKDIV_4 1
> > +#define MCLKDIV_2 2
> > +
> > +#define WORDCNT_REG 0x0022
> > +#define PP_MISC_REG 0x0032
> > +#define FRMSTOP BIT(15)
> > +#define RSTPTR BIT(14)
> > +
> > +/* 32-bit registers */
> > +#define CLW_DPHYCONTTX_REG 0x0100
> > +#define CLW_CNTRL_REG 0x0140
> > +#define D0W_CNTRL_REG 0x0144
> > +#define LANEDISABLE BIT(0)
> > +
> > +#define STARTCNTRL_REG 0x0204
> > +#define START BIT(0)
> > +
> > +#define LINEINITCNT_REG 0x0210
> > +#define LPTXTIMECNT_REG 0x0214
> > +#define TCLK_HEADERCNT_REG 0x0218
> > +#define TCLK_ZEROCNT(val) FIELD_PREP(GENMASK(15, 8), (val))
> > +#define TCLK_PREPARECNT(val) FIELD_PREP(GENMASK(6, 0), (val))
> > +
> > +#define TCLK_TRAILCNT_REG 0x021C
> > +#define THS_HEADERCNT_REG 0x0220
> > +#define THS_ZEROCNT(val) FIELD_PREP(GENMASK(14, 8), (val))
> > +#define THS_PREPARECNT(val) FIELD_PREP(GENMASK(6, 0), (val))
> > +
> > +#define TWAKEUP_REG 0x0224
> > +#define TCLK_POSTCNT_REG 0x0228
> > +#define THS_TRAILCNT_REG 0x022C
> > +#define HSTXVREGEN_REG 0x0234
> > +#define TXOPTIONCNTRL_REG 0x0238
> > +#define CSI_CONTROL_REG 0x040C
> > +#define CSI_MODE BIT(15)
> > +#define TXHSMD BIT(7)
> > +#define NOL(val) FIELD_PREP(GENMASK(2, 1), (val))
> > +
> > +#define CSI_CONFW_REG 0x0500
> > +#define MODE(val) FIELD_PREP(GENMASK(31, 29), (val))
> > +#define MODE_SET 0x5
> > +#define ADDRESS(val) FIELD_PREP(GENMASK(28, 24), (val))
> > +#define CSI_CONTROL_ADDRESS 0x3
> > +#define DATA(val) FIELD_PREP(GENMASK(15, 0), (val))
> > +
> > +#define CSI_START_REG 0x0518
> > +#define STRT BIT(0)
> > +
> > +static const struct v4l2_mbus_framefmt tc358746_def_fmt = {
> > + .width = 640,
> > + .height = 480,
> > + .code = MEDIA_BUS_FMT_UYVY8_2X8,
> > + .field = V4L2_FIELD_NONE,
> > + .colorspace = V4L2_COLORSPACE_DEFAULT,
> > + .ycbcr_enc = V4L2_YCBCR_ENC_DEFAULT,
> > + .quantization = V4L2_QUANTIZATION_DEFAULT,
> > + .xfer_func = V4L2_XFER_FUNC_DEFAULT,
> > +};
> > +
> > +static const char * const tc358746_supplies[] = {
> > + "vddc", "vddio", "vddmipi"
> > +};
> > +
> > +enum {
> > + TC358746_SINK,
> > + TC358746_SOURCE,
> > + TC358746_NR_PADS
> > +};
> > +
> > +struct tc358746 {
> > + struct v4l2_subdev sd;
> > + struct media_pad pads[TC358746_NR_PADS];
> > + struct v4l2_async_notifier notifier;
> > + struct v4l2_mbus_framefmt mbusfmt;
>
> Could you use the active state API instead of manually storing mbusfmt
> here ? It involves
I will do that, thanks for the hint and it also elimates a few basic
checks like the pad-num check.
> - Implementing the .init_cfg() operation
> - Calling v4l2_subdev_init_finalize() in probe
> - Replacing calls to __tc358746_get_pad_format() with
> v4l2_subdev_get_pad_format()
> - Propagating the format from sink to source in tc358746_set_fmt()
> - Dropping tc358746_src_mbus_code() from tc358746_get_fmt() and simply
> retrieving the format using v4l2_subdev_get_pad_format() there
> - Dropping this field
>
> The formats for both the ACTIVE and TRY states will then be stored in
> the subdev state, unconditionally. You can retrieve the active state
> with v4l2_subdev_get_locked_active_state() in tc358746_s_stream().
>
> > + struct v4l2_fwnode_endpoint csi_vep;
> > +
> > + struct v4l2_ctrl_handler ctrl_hdl;
> > +
> > + struct regmap *regmap;
> > + struct clk *refclk;
> > + struct gpio_desc *reset_gpio;
> > + struct regulator_bulk_data supplies[ARRAY_SIZE(tc358746_supplies)];
> > +
> > + struct clk_hw mclk_hw;
> > + unsigned long mclk_rate;
> > + u8 mclk_prediv;
> > + u16 mclk_postdiv;
> > +
> > + unsigned long pll_rate;
> > + u8 pll_post_div;
> > + u16 pll_pre_div;
> > + u16 pll_mul;
> > +
> > + struct v4l2_ctrl *sensor_pclk_ctrl;
> > +
> > +#define TC358746_VB_MAX_SIZE (511 * 32)
> > +#define TC358746_VB_DEFAULT_SIZE (1 * 32)
> > + unsigned int vb_size; /* Video buffer size in bits */
> > +
> > + struct phy_configure_opts_mipi_dphy dphy_cfg;
> > +};
> > +
> > +static inline struct tc358746 *to_tc358746(struct v4l2_subdev *sd)
> > +{
> > + return container_of(sd, struct tc358746, sd);
> > +}
> > +
> > +static inline struct tc358746 *clk_hw_to_tc358746(struct clk_hw *hw)
> > +{
> > + return container_of(hw, struct tc358746, mclk_hw);
> > +}
> > +
> > +struct tc358746_format {
> > + u32 code;
> > + bool csi_format;
> > + unsigned char bus_width;
> > + unsigned char bpp;
> > + /* Register values */
> > + u8 pdformat; /* Peripheral Data Format */
> > + u8 pdataf; /* Parallel Data Format Option */
> > +};
> > +
> > +enum {
> > + PDFORMAT_RAW8 = 0,
> > + PDFORMAT_RAW10,
> > + PDFORMAT_RAW12,
> > + PDFORMAT_RGB888,
> > + PDFORMAT_RGB666,
> > + PDFORMAT_RGB565,
> > + PDFORMAT_YUV422_8BIT,
> > + /* RESERVED = 7 */
> > + PDFORMAT_RAW14 = 8,
> > + PDFORMAT_YUV422_10BIT,
> > + PDFORMAT_YUV444,
> > +};
> > +
> > +/* Check tc358746_src_mbus_code() if you add new formats */
> > +static const struct tc358746_format tc358746_formats[] = {
> > + {
> > + .code = MEDIA_BUS_FMT_UYVY8_2X8,
> > + .bus_width = 8,
> > + .bpp = 16,
> > + .pdformat = PDFORMAT_YUV422_8BIT,
> > + .pdataf = PDATAF_MODE0,
> > + }, {
> > + .code = MEDIA_BUS_FMT_UYVY8_1X16,
> > + .csi_format = true,
> > + .bus_width = 16,
> > + .bpp = 16,
> > + .pdformat = PDFORMAT_YUV422_8BIT,
> > + .pdataf = PDATAF_MODE1,
> > + }, {
> > + .code = MEDIA_BUS_FMT_YUYV8_1X16,
> > + .csi_format = true,
> > + .bus_width = 16,
> > + .bpp = 16,
> > + .pdformat = PDFORMAT_YUV422_8BIT,
> > + .pdataf = PDATAF_MODE2,
> > + }, {
> > + .code = MEDIA_BUS_FMT_UYVY10_2X10,
> > + .bus_width = 10,
> > + .bpp = 20,
> > + .pdformat = PDFORMAT_YUV422_10BIT,
> > + .pdataf = PDATAF_MODE0, /* don't care */
> > + }, {
> > + /* in datasheet listed as YUV444 */
> > + .code = MEDIA_BUS_FMT_GBR888_1X24,
> > + .csi_format = true,
> > + .bus_width = 24,
> > + .bpp = 24,
> > + .pdformat = PDFORMAT_YUV444,
>
> This looks quite weird, does 24-bit RGB really map to the CSI-2 YUV444
> data type ?
It is written in the comments.. but I can drop for now since I don't
have a device to ensure it.
> > + .pdataf = PDATAF_MODE0, /* don't care */
> > + },
> > +};
> > +
> > +/* Get n-th format for pad */
> > +static const struct tc358746_format *
> > +tc358746_get_format_by_idx(unsigned int pad, unsigned int index)
> > +{
> > + unsigned int idx = 0;
> > + unsigned int i;
> > +
> > + if (pad >= TC358746_NR_PADS)
> > + return ERR_PTR(-EINVAL);
>
> That should be tested by the subdev core, I think you can drop the
> check. Same below.
Yes, thanks :)
> > +
> > + for (i = 0; i < ARRAY_SIZE(tc358746_formats); i++) {
> > + const struct tc358746_format *fmt = &tc358746_formats[i];
> > +
> > + if ((pad == TC358746_SOURCE && fmt->csi_format) ||
> > + (pad == TC358746_SINK)) {
> > + if (idx == index)
> > + return fmt;
> > + idx++;
> > + }
> > + }
> > +
> > + return ERR_PTR(-EINVAL);
> > +}
> > +
> > +static const struct tc358746_format *
> > +tc358746_get_format_by_code(unsigned int pad, u32 code)
> > +{
> > + unsigned int i;
> > +
> > + if (pad >= TC358746_NR_PADS)
> > + return ERR_PTR(-EINVAL);
> > +
> > + for (i = 0; i < ARRAY_SIZE(tc358746_formats); i++) {
> > + const struct tc358746_format *fmt = &tc358746_formats[i];
> > +
> > + if (pad == TC358746_SINK && fmt->code == code)
> > + return fmt;
> > +
> > + if (pad == TC358746_SOURCE && fmt->csi_format &&
> > + fmt->code == code)
> > + return fmt;
>
> You could also write
>
> if (pad == TC358746_SOURCE && !fmt->csi_format)
> continue;
>
> if (fmt->code == code)
> return fmt;
>
> Up to you.
Okay, I will do that.
> > + }
> > +
> > + return ERR_PTR(-EINVAL);
> > +}
> > +
> > +static u32 tc358746_src_mbus_code(u32 code)
> > +{
> > + switch (code) {
> > + case MEDIA_BUS_FMT_UYVY8_2X8:
> > + return MEDIA_BUS_FMT_UYVY8_1X16;
> > + case MEDIA_BUS_FMT_UYVY10_2X10:
> > + return MEDIA_BUS_FMT_UYVY10_1X20;
> > + default:
> > + return code;
> > + }
> > +}
> > +
> > +static bool tc358746_writeable_reg(struct device *dev, unsigned int reg)
> > +{
> > + switch (reg) {
> > + case SYSCTL_REG ... CSI_START_REG:
> > + return true;
> > + default:
> > + return false;
> > + }
> > +}
> > +
> > +static bool tc358746_readable_reg(struct device *dev, unsigned int reg)
> > +{
> > + switch (reg) {
> > + case CHIPID_REG ... CSI_START_REG:
> > + return true;
> > + default:
> > + return false;
> > + }
> > +}
> > +
> > +static const struct regmap_config tc358746_regmap_config = {
> > + .name = "tc358746",
> > + .reg_bits = 16,
> > + .val_bits = 16,
> > + .max_register = CSI_START_REG,
> > + .writeable_reg = tc358746_writeable_reg,
> > + .readable_reg = tc358746_readable_reg,
> > + .reg_format_endian = REGMAP_ENDIAN_BIG,
> > + .val_format_endian = REGMAP_ENDIAN_BIG,
> > +};
> > +
> > +static int tc358746_write(struct tc358746 *tc358746, u32 reg, u32 val)
> > +{
> > + size_t count;
> > +
> > + /* 32-bit registers starting from CLW_DPHYCONTTX */
> > + count = reg < CLW_DPHYCONTTX_REG ? 1 : 2;
> > +
> > + return regmap_bulk_write(tc358746->regmap, reg, &val, count);
> > +}
> > +
> > +static int tc358746_read(struct tc358746 *tc358746, u32 reg, u32 *val)
> > +{
> > + size_t count;
> > +
> > + /* 32-bit registers starting from CLW_DPHYCONTTX */
> > + count = reg < CLW_DPHYCONTTX_REG ? 1 : 2;
> > + *val = 0;
> > +
> > + return regmap_bulk_read(tc358746->regmap, reg, val, count);
> > +}
> > +
> > +static int
> > +tc358746_update_bits(struct tc358746 *tc358746, u32 reg, u32 mask, u32 val)
> > +{
> > + u32 tmp, orig;
> > + int err;
> > +
> > + err = tc358746_read(tc358746, reg, &orig);
> > + if (err)
> > + return err;
> > +
> > + tmp = orig & ~mask;
> > + tmp |= val & mask;
> > +
> > + return tc358746_write(tc358746, reg, tmp);
> > +}
> > +
> > +static int tc358746_set_bits(struct tc358746 *tc358746, u32 reg, u32 bits)
> > +{
> > + return tc358746_update_bits(tc358746, reg, bits, bits);
> > +}
> > +
> > +static int tc358746_clear_bits(struct tc358746 *tc358746, u32 reg, u32 bits)
> > +{
> > + return tc358746_update_bits(tc358746, reg, bits, 0);
> > +}
> > +
> > +static int tc358746_sw_reset(struct tc358746 *tc358746)
> > +{
> > + int err;
> > +
> > + err = tc358746_set_bits(tc358746, SYSCTL_REG, SRESET);
> > + if (err)
> > + return err;
> > +
> > + udelay(10);
> > +
> > + return tc358746_clear_bits(tc358746, SYSCTL_REG, SRESET);
> > +}
> > +
> > +static int
> > +tc358746_apply_pll_config(struct tc358746 *tc358746)
> > +{
> > + u8 post = tc358746->pll_post_div;
> > + u16 pre = tc358746->pll_pre_div;
> > + u16 mul = tc358746->pll_mul;
> > + u32 val, mask;
> > + int err;
> > +
> > + err = tc358746_read(tc358746, PLLCTL1_REG, &val);
> > + if (err)
> > + return err;
> > +
> > + /* Don't touch the PLL if running */
> > + if (FIELD_GET(PLL_EN, val) == 1)
> > + return 0;
> > +
> > + /* Pre-div and Multiplicator have a internal +1 logic */
> > + val = PLL_PRD(pre - 1) | PLL_FBD(mul - 1);
> > + mask = PLL_PRD_MASK | PLL_FBD_MASK;
> > + err = tc358746_update_bits(tc358746, PLLCTL0_REG, mask, val);
> > + if (err)
> > + return err;
> > +
> > + val = PLL_FRS(ilog2(post)) | RESETB | PLL_EN;
> > + mask = PLL_FRS_MASK | RESETB | PLL_EN;
> > + tc358746_update_bits(tc358746, PLLCTL1_REG, mask, val);
> > + if (err)
> > + return err;
> > +
> > + udelay(1000);
> > +
> > + return tc358746_set_bits(tc358746, PLLCTL1_REG, CKEN);
> > +}
> > +
> > +static int tc358746_apply_misc_config(struct tc358746 *tc358746)
> > +{
> > + struct device *dev = tc358746->sd.dev;
> > + const struct tc358746_format *fmt;
> > + u32 val;
> > + int err;
> > +
> > + fmt = tc358746_get_format_by_code(TC358746_SINK, tc358746->mbusfmt.code);
> > + if (IS_ERR(fmt))
> > + return PTR_ERR(fmt);
>
> mbusfmt.code is supposed to have been validated, so you can drop the
> error check here.
Yes.
> > +
> > + /* Self defined CSI user data type id's are not supported yet */
> > + val = PDFMT(fmt->pdformat);
> > + dev_dbg(dev, "DATAFMT: 0x%x\n", val);
> > + err = tc358746_write(tc358746, DATAFMT_REG, val);
> > + if (err)
> > + return err;
> > +
> > + val = PDATAF(fmt->pdataf);
> > + dev_dbg(dev, "CONFCTL[PDATAF]: 0x%x\n", fmt->pdataf);
> > + err = tc358746_update_bits(tc358746, CONFCTL_REG, PDATAF_MASK, val);
> > + if (err)
> > + return err;
> > +
> > + val = tc358746->vb_size / 32;
> > + dev_dbg(dev, "FIFOCTL: %u (0x%x)\n", val, val);
> > + err = tc358746_write(tc358746, FIFOCTL_REG, val);
> > + if (err)
> > + return err;
> > +
> > + /* Total number of bytes for each line/width */
> > + val = tc358746->mbusfmt.width * fmt->bpp / 8;
> > + dev_dbg(dev, "WORDCNT: %u (0x%x)\n", val, val);
> > + return tc358746_write(tc358746, WORDCNT_REG, val);
> > +}
> > +
> > +#ifndef MHZ
>
> Where would it be previously defined ? This sounds like asking for
> trouble later.
Sorry I don't get that, do you mean that I should define it at the very
beginning?
> > +#define MHZ (1000 * 1000)
> > +#endif
> > +
> > +/* Use MHz as base so the div needs no u64 */
> > +static u32 tc358746_cfg_to_cnt(unsigned int cfg_val,
> > + unsigned int clk_mhz,
> > + unsigned int time_base)
> > +{
> > + return DIV_ROUND_UP(cfg_val * clk_mhz, time_base);
> > +}
> > +
> > +static u32 tc358746_ps_to_cnt(unsigned int cfg_val,
> > + unsigned int clk_mhz)
> > +{
> > + return tc358746_cfg_to_cnt(cfg_val, clk_mhz, USEC_PER_SEC);
> > +}
> > +
> > +static u32 tc358746_us_to_cnt(unsigned int cfg_val,
> > + unsigned int clk_mhz)
> > +{
> > + return tc358746_cfg_to_cnt(cfg_val, clk_mhz, 1);
> > +}
> > +
> > +static int tc358746_apply_dphy_config(struct tc358746 *tc358746)
> > +{
> > + struct phy_configure_opts_mipi_dphy *cfg = &tc358746->dphy_cfg;
> > + bool non_cont_clk = !!(tc358746->csi_vep.bus.mipi_csi2.flags &
> > + V4L2_MBUS_CSI2_NONCONTINUOUS_CLOCK);
> > + struct device *dev = tc358746->sd.dev;
> > + unsigned long hs_byte_clk, hf_clk;
> > + u32 val, val2, lptxcnt;
> > + int err;
> > +
> > + /* The hs_byte_clk is also called SYSCLK in the excel sheet */
> > + hs_byte_clk = cfg->hs_clk_rate / 8;
> > + hs_byte_clk /= MHZ;
> > + hf_clk = hs_byte_clk / 2;
> > +
> > + val = tc358746_us_to_cnt(cfg->init, hf_clk) - 1;
> > + dev_dbg(dev, "LINEINITCNT: %u (0x%x)\n", val, val);
> > + err = tc358746_write(tc358746, LINEINITCNT_REG, val);
> > + if (err)
> > + return err;
> > +
> > + val = tc358746_ps_to_cnt(cfg->lpx, hs_byte_clk) - 1;
> > + lptxcnt = val;
> > + dev_dbg(dev, "LPTXTIMECNT: %u (0x%x)\n", val, val);
> > + err = tc358746_write(tc358746, LPTXTIMECNT_REG, val);
> > + if (err)
> > + return err;
> > +
> > + val = tc358746_ps_to_cnt(cfg->clk_prepare, hs_byte_clk) - 1;
> > + val2 = tc358746_ps_to_cnt(cfg->clk_zero, hs_byte_clk) - 1;
> > + dev_dbg(dev, "TCLK_PREPARECNT: %u (0x%x)\n", val, val);
> > + dev_dbg(dev, "TCLK_ZEROCNT: %u (0x%x)\n", val2, val2);
> > + dev_dbg(dev, "TCLK_HEADERCNT: 0x%x\n",
> > + (u32)(TCLK_PREPARECNT(val) | TCLK_ZEROCNT(val2)));
> > + err = tc358746_write(tc358746, TCLK_HEADERCNT_REG,
> > + TCLK_PREPARECNT(val) | TCLK_ZEROCNT(val2));
> > + if (err)
> > + return err;
> > +
> > + val = tc358746_ps_to_cnt(cfg->clk_trail, hs_byte_clk);
> > + dev_dbg(dev, "TCLK_TRAILCNT: %u (0x%x)\n", val, val);
> > + err = tc358746_write(tc358746, TCLK_TRAILCNT_REG, val);
> > + if (err)
> > + return err;
> > +
> > + val = tc358746_ps_to_cnt(cfg->hs_prepare, hs_byte_clk) - 1;
> > + val2 = tc358746_ps_to_cnt(cfg->hs_zero, hs_byte_clk) - 1;
> > + dev_dbg(dev, "THS_PREPARECNT: %u (0x%x)\n", val, val);
> > + dev_dbg(dev, "THS_ZEROCNT: %u (0x%x)\n", val2, val2);
> > + dev_dbg(dev, "THS_HEADERCNT: 0x%x\n",
> > + (u32)(THS_PREPARECNT(val) | THS_ZEROCNT(val2)));
> > + err = tc358746_write(tc358746, THS_HEADERCNT_REG,
> > + THS_PREPARECNT(val) | THS_ZEROCNT(val2));
> > + if (err)
> > + return err;
> > +
> > + /* TWAKEUP > 1ms in lptxcnt steps */
> > + val = tc358746_us_to_cnt(cfg->wakeup, hs_byte_clk);
> > + val = val / (lptxcnt + 1) - 1;
> > + dev_dbg(dev, "TWAKEUP: %u (0x%x)\n", val, val);
> > + err = tc358746_write(tc358746, TWAKEUP_REG, val);
> > + if (err)
> > + return err;
> > +
> > + val = tc358746_ps_to_cnt(cfg->clk_post, hs_byte_clk);
> > + dev_dbg(dev, "TCLK_POSTCNT: %u (0x%x)\n", val, val);
> > + err = tc358746_write(tc358746, TCLK_POSTCNT_REG, val);
> > + if (err)
> > + return err;
> > +
> > + val = tc358746_ps_to_cnt(cfg->hs_trail, hs_byte_clk);
> > + dev_dbg(dev, "THS_TRAILCNT: %u (0x%x)\n", val, val);
> > + err = tc358746_write(tc358746, THS_TRAILCNT_REG, val);
> > + if (err)
> > + return err;
> > +
> > + dev_dbg(dev, "CONTCLKMODE: %u", non_cont_clk ? 0 : 1);
> > + return tc358746_write(tc358746, TXOPTIONCNTRL_REG, non_cont_clk ? 0 : 1);
> > +}
> > +
> > +#define MAX_DATA_LANES 4
> > +
> > +static int tc358746_enable_csi_lanes(struct tc358746 *tc358746, int enable)
> > +{
> > + unsigned int lanes = tc358746->dphy_cfg.lanes;
> > + unsigned int lane;
> > + u32 reg, val;
> > + int err;
> > +
> > + err = tc358746_update_bits(tc358746, CONFCTL_REG, DATALANE_MASK,
> > + lanes - 1);
> > + if (err)
> > + return err;
> > +
> > + /* Clock lane */
> > + val = enable ? 0 : LANEDISABLE;
> > + dev_dbg(tc358746->sd.dev, "CLW_CNTRL: 0x%x\n", val);
> > + err = tc358746_write(tc358746, CLW_CNTRL_REG, val);
> > + if (err)
> > + return err;
> > +
> > + for (lane = 0; lane < MAX_DATA_LANES; lane++) {
> > + /* Data lanes */
> > + reg = D0W_CNTRL_REG + lane * 0x4;
> > + val = (enable && lane < lanes) ? 0 : LANEDISABLE;
> > +
> > + dev_dbg(tc358746->sd.dev, "D%uW_CNTRL: 0x%x\n", lane, val);
> > + err = tc358746_write(tc358746, reg, val);
> > + if (err)
> > + return err;
> > + }
> > +
> > + val = 0;
> > + if (enable) {
> > + /* Clock lane */
> > + val |= BIT(0);
> > +
> > + /* Data lanes */
> > + for (lane = 1; lane <= lanes; lane++)
> > + val |= BIT(lane);
> > + }
> > +
> > + dev_dbg(tc358746->sd.dev, "HSTXVREGEN: 0x%x\n", val);
> > + return tc358746_write(tc358746, HSTXVREGEN_REG, val);
> > +}
> > +
> > +static int tc358746_enable_csi_module(struct tc358746 *tc358746, int enable)
> > +{
> > + unsigned int lanes = tc358746->dphy_cfg.lanes;
> > + int err;
> > +
> > + /*
> > + * START and STRT are only reseted/disabled by sw reset. This is
> > + * required to put the lane state back into LP-11 state. The sw reset
> > + * don't reset register values.
> > + */
> > + if (!enable)
> > + return tc358746_sw_reset(tc358746);
> > +
> > + err = tc358746_write(tc358746, STARTCNTRL_REG, START);
> > + if (err)
> > + return err;
> > +
> > + err = tc358746_write(tc358746, CSI_START_REG, STRT);
> > + if (err)
> > + return err;
> > +
> > + /* CSI_CONTROL_REG is only indirect accessible */
> > + return tc358746_write(tc358746, CSI_CONFW_REG,
> > + MODE(MODE_SET) |
> > + ADDRESS(CSI_CONTROL_ADDRESS) |
> > + DATA(CSI_MODE | TXHSMD | NOL(lanes - 1)));
> > +}
> > +
> > +static int tc358746_enable_parallel_port(struct tc358746 *tc358746, int enable)
> > +{
> > + int err;
> > +
> > + if (enable) {
> > + err = tc358746_write(tc358746, PP_MISC_REG, 0);
> > + if (err)
> > + return err;
> > +
> > + return tc358746_set_bits(tc358746, CONFCTL_REG, PPEN);
> > + }
> > +
> > + err = tc358746_set_bits(tc358746, PP_MISC_REG, FRMSTOP);
> > + if (err)
> > + return err;
> > +
> > + err = tc358746_clear_bits(tc358746, CONFCTL_REG, PPEN);
> > + if (err)
> > + return err;
> > +
> > + return tc358746_set_bits(tc358746, PP_MISC_REG, RSTPTR);
> > +}
> > +
> > +static inline struct v4l2_subdev *tc358746_get_remote_sd(struct media_pad *pad)
> > +{
> > + pad = media_pad_remote_pad_first(pad);
> > + if (!pad)
> > + return NULL;
> > +
> > + return media_entity_to_v4l2_subdev(pad->entity);
> > +}
> > +
> > +static int tc358746_s_stream(struct v4l2_subdev *sd, int enable)
> > +{
> > + struct tc358746 *tc358746 = to_tc358746(sd);
> > + struct v4l2_subdev *src;
> > + int err;
> > +
> > + dev_dbg(sd->dev, "%sable\n", enable ? "en" : "dis");
> > +
> > + src = tc358746_get_remote_sd(&tc358746->pads[TC358746_SINK]);
> > + if (!src)
> > + return -EPIPE;
> > +
> > + if (enable) {
> > + err = pm_runtime_resume_and_get(sd->dev);
> > + if (err)
> > + return err;
> > +
> > + err = tc358746_enable_csi_lanes(tc358746, 1);
> > + if (err) {
> > + pm_runtime_mark_last_busy(sd->dev);
> > + pm_runtime_put_sync_autosuspend(sd->dev);
> > + return err;
>
> Looks like a candidate for a goto statement.
Thought about it too but than I thought about the placement of the
label and I went this way. I can change it. Should the label placed at
the end of the function or at the end of this block.
> > + }
> > +
> > + err = tc358746_enable_csi_module(tc358746, 1);
> > + if (err) {
> > + pm_runtime_mark_last_busy(sd->dev);
> > + pm_runtime_put_sync_autosuspend(sd->dev);
> > + return err;
> > + }
> > +
> > + err = tc358746_enable_parallel_port(tc358746, 1);
> > + if (err) {
> > + pm_runtime_mark_last_busy(sd->dev);
> > + pm_runtime_put_sync_autosuspend(sd->dev);
> > + return err;
> > + }
> > +
> > + err = v4l2_subdev_call(src, video, s_stream, 1);
> > + if (err) {
> > + pm_runtime_mark_last_busy(sd->dev);
> > + pm_runtime_put_sync_autosuspend(sd->dev);
> > + }
> > +
> > + return err;
> > + }
> > +
> > + /*
> > + * Lane disable trigger state change from LP-11 to LP-00
> > + * therefore it must happen before the CSI modile is disabled.
> > + */
> > + err = tc358746_enable_csi_lanes(tc358746, 0);
> > + if (err)
> > + return err;
> > +
> > + err = tc358746_enable_csi_module(tc358746, 0);
> > + if (err)
> > + return err;
> > +
> > + err = tc358746_enable_parallel_port(tc358746, 0);
> > + if (err)
> > + return err;
> > +
> > + pm_runtime_mark_last_busy(sd->dev);
> > + pm_runtime_put_sync_autosuspend(sd->dev);
> > +
> > + return v4l2_subdev_call(src, video, s_stream, 0);
> > +}
> > +
> > +static int tc358746_enum_mbus_code(struct v4l2_subdev *sd,
> > + struct v4l2_subdev_state *sd_state,
> > + struct v4l2_subdev_mbus_code_enum *code)
> > +{
> > + const struct tc358746_format *fmt;
> > +
> > + fmt = tc358746_get_format_by_idx(code->pad, code->index);
> > + if (IS_ERR(fmt))
> > + return PTR_ERR(fmt);
> > +
> > + code->code = fmt->code;
> > +
> > + return 0;
> > +}
> > +
> > +static struct v4l2_mbus_framefmt *
> > +__tc358746_get_pad_format(struct v4l2_subdev *sd,
> > + struct v4l2_subdev_state *sd_state,
> > + unsigned int pad, u32 which)
> > +{
> > + struct tc358746 *tc358746 = to_tc358746(sd);
> > +
> > + switch (which) {
> > + case V4L2_SUBDEV_FORMAT_TRY:
> > + return v4l2_subdev_get_try_format(sd, sd_state, pad);
> > + case V4L2_SUBDEV_FORMAT_ACTIVE:
> > + return &tc358746->mbusfmt;
> > + default:
> > + return NULL;
> > + }
> > +}
> > +
> > +static int tc358746_get_fmt(struct v4l2_subdev *sd,
> > + struct v4l2_subdev_state *sd_state,
> > + struct v4l2_subdev_format *format)
> > +{
> > + struct tc358746 *tc358746 = to_tc358746(sd);
> > +
> > + if (format->pad >= TC358746_NR_PADS)
> > + return -EINVAL;
> > +
> > + format->format = tc358746->mbusfmt;
> > + if (format->pad == TC358746_SOURCE)
> > + format->format.code = tc358746_src_mbus_code(tc358746->mbusfmt.code);
> > +
> > + return 0;
> > +}
> > +
> > +static int tc358746_set_fmt(struct v4l2_subdev *sd,
> > + struct v4l2_subdev_state *sd_state,
> > + struct v4l2_subdev_format *format)
> > +{
> > + struct v4l2_mbus_framefmt *mbusformat;
> > + const struct tc358746_format *fmt;
> > +
> > + if (format->pad >= TC358746_NR_PADS)
> > + return -EINVAL;
> > +
> > + /* The src follows the properties from the sink */
> > + if (format->pad == TC358746_SOURCE)
> > + return tc358746_get_fmt(sd, sd_state, format);
> > +
> > + mbusformat = __tc358746_get_pad_format(sd, sd_state, format->pad,
> > + format->which);
> > + if (!mbusformat)
> > + return -EINVAL;
> > +
> > + fmt = tc358746_get_format_by_code(format->pad, format->format.code);
> > + if (IS_ERR(fmt))
> > + fmt = tc358746_get_format_by_code(format->pad, tc358746_def_fmt.code);
> > +
> > + format->format.code = fmt->code;
> > + format->format.field = V4L2_FIELD_NONE;
> > +
> > + dev_dbg(sd->dev, "Update format: %ux%u code:0x%x -> %ux%u code:0x%x",
> > + mbusformat->width, mbusformat->height, mbusformat->code,
> > + format->format.width, format->format.height, format->format.code);
> > +
> > + *mbusformat = format->format;
> > +
> > + return 0;
> > +}
> > +
> > +static unsigned long tc358746_find_pll_settings(struct tc358746 *tc358746,
> > + unsigned long refclk,
> > + unsigned long fout)
> > +
> > +{
> > + struct device *dev = tc358746->sd.dev;
> > + unsigned long best_freq = 0;
> > + u32 min_delta = 0xffffffff;
> > + u16 prediv_max = 17;
> > + u16 prediv_min = 1;
> > + u16 m_best, mul;
> > + u16 p_best, p;
> > + u8 postdiv;
> > +
> > + if (fout > 1000 * MHZ) {
> > + dev_err(dev, "HS-Clock above 1 Ghz are not supported\n");
> > + return 0;
> > + } else if (fout >= 500 * MHZ)
> > + postdiv = 1;
> > + else if (fout >= 250 * MHZ)
> > + postdiv = 2;
> > + else if (fout >= 125 * MHZ)
> > + postdiv = 4;
> > + else
> > + postdiv = 8;
> > +
> > + for (p = prediv_min; p <= prediv_max; p++) {
> > + unsigned long delta, fin;
> > + u64 tmp;
> > +
> > + fin = DIV_ROUND_CLOSEST(refclk, p);
> > + if (fin < 4 * MHZ || fin > 40 * MHZ)
> > + continue;
> > +
> > + tmp = fout * p * postdiv;
> > + do_div(tmp, fin);
> > + mul = tmp;
> > + if (mul > 511)
> > + continue;
> > +
> > + tmp = mul * fin;
> > + do_div(tmp, p * postdiv);
> > +
> > + delta = abs(fout - tmp);
> > + if (delta < min_delta) {
> > + p_best = p;
> > + m_best = mul;
> > + min_delta = delta;
> > + best_freq = tmp;
> > + };
> > +
> > + if (delta == 0)
> > + break;
> > + };
> > +
> > + if (!best_freq) {
> > + dev_err(dev, "Failed find PLL frequency\n");
> > + return 0;
> > + }
> > +
> > + tc358746->pll_post_div = postdiv;
> > + tc358746->pll_pre_div = p_best;
> > + tc358746->pll_mul = m_best;
> > +
> > + if (best_freq != fout)
> > + dev_warn(dev, "Request PLL freq:%lu, found PLL freq:%lu\n",
> > + fout, best_freq);
> > +
> > + dev_dbg(dev, "Found PLL settings: freq:%lu prediv:%u multi:%u postdiv:%u\n",
> > + best_freq, p_best, m_best, postdiv);
> > +
> > + return best_freq;
> > +}
> > +
> > +#define TC358746_PRECISION 10
> > +
> > +static int
> > +tc358746_link_validate(struct v4l2_subdev *sd, struct media_link *link,
> > + struct v4l2_subdev_format *source_fmt,
> > + struct v4l2_subdev_format *sink_fmt)
> > +{
> > + struct tc358746 *tc358746 = to_tc358746(sd);
> > + unsigned long csi_bitrate, sensor_bitrate;
> > + const struct tc358746_format *fmt;
> > + unsigned int fifo_sz, tmp, n;
> > + s64 sensor_pclk_rate;
> > +
> > + /* Check the FIFO settings */
> > + fmt = tc358746_get_format_by_code(TC358746_SINK, tc358746->mbusfmt.code);
> > + if (IS_ERR(fmt))
> > + return PTR_ERR(fmt);
> > +
> > + sensor_pclk_rate = v4l2_ctrl_g_ctrl_int64(tc358746->sensor_pclk_ctrl);
> > + sensor_bitrate = sensor_pclk_rate * fmt->bus_width;
> > +
> > + csi_bitrate = tc358746->dphy_cfg.lanes * tc358746->pll_rate;
> > +
> > + dev_dbg(tc358746->sd.dev,
> > + "Fifo settings params: sensor-bitrate:%lu csi-bitrate:%lu",
> > + sensor_bitrate, csi_bitrate);
> > +
> > + /* Avoid possible FIFO overflows */
> > + if (csi_bitrate < sensor_bitrate) {
> > + dev_err(sd->dev,
> > + "Link validation failed csi-bitrate:%lu < sensor-bitrate:%lu\n",
> > + csi_bitrate, sensor_bitrate);
> > + return -EINVAL;
> > + }
> > +
> > + /* Best case */
> > + if (csi_bitrate == sensor_bitrate) {
> > + tc358746->vb_size = TC358746_VB_DEFAULT_SIZE;
> > + goto out;
> > + }
> > +
> > + /*
> > + * Avoid possible FIFO underflow in case of
> > + * csi_bitrate > sensor_bitrate. For such case the chip has a internal
> > + * fifo which can be used to delay the line output.
> > + *
> > + * Fifo size calculation:
> > + *
> > + * fifo-sz, image-width - in bits
> > + * sbr - sensor_bitrate in bits/s
> > + * csir - csi_bitrate in bits/s
> > + *
> > + * 1 1 1
> > + * image-width * --- + fifo-sz --- >= ---- * image-width
> > + * sbr sbr csir
> > + *
> > + * fifo-sz >= abs(sbr/csir * image-width - image-width)
> > + * `-----´
> > + * n
> > + *
> > + */
> > +
> > + sensor_bitrate /= TC358746_PRECISION;
> > + n = csi_bitrate / sensor_bitrate;
> > + tmp = (tc358746->mbusfmt.width * TC358746_PRECISION) / n;
> > + fifo_sz = tc358746->mbusfmt.width - tmp;
> > + fifo_sz *= fmt->bpp;
> > + tc358746->vb_size = round_up(fifo_sz, 32);
> > +
>
> Please also call v4l2_subdev_link_validate_default() here.
Did it in my internal prepared v2 ^^ I call it now at the very
beginning of this function.
> I wonder if the above calculation wouldn't be better performed in
> .s_stream() (or rather in a function being called by .s_stream()) when
> enabling streaming.
No I wouldn't shift that, since the link validation is in IMHO the
correct place to inform the user that the pipeline can't negotiate if
the fifo can't be configured correctly. Therefore I placed it here.
> > +out:
> > + dev_dbg(tc358746->sd.dev,
> > + "Found FIFO size[bits]:%u -> aligned to size[bits]:%u\n",
> > + fifo_sz, tc358746->vb_size);
> > +
> > + return tc358746->vb_size > TC358746_VB_MAX_SIZE ? -EINVAL : 0;
> > +}
> > +
> > +static int tc358746_get_mbus_config(struct v4l2_subdev *sd, unsigned int pad,
> > + struct v4l2_mbus_config *config)
> > +{
> > + struct tc358746 *tc358746 = to_tc358746(sd);
> > +
> > + if (pad != TC358746_SOURCE)
> > + return -EINVAL;
> > +
> > + config->type = V4L2_MBUS_CSI2_DPHY;
> > + config->bus.mipi_csi2 = tc358746->csi_vep.bus.mipi_csi2;
> > +
> > + return 0;
> > +}
> > +
> > +static int tc358746_link_setup(struct media_entity *entity,
> > + const struct media_pad *local,
> > + const struct media_pad *remote, u32 flags)
> > +{
> > + struct v4l2_subdev *sd = media_entity_to_v4l2_subdev(entity);
> > + struct v4l2_subdev *sensor_sd =
> > + media_entity_to_v4l2_subdev(remote->entity);
> > + struct tc358746 *tc358746 = to_tc358746(sd);
> > + struct device *dev = sd->dev;
> > + struct v4l2_ctrl *ctrl;
> > +
> > + /* no special requirements on source pads */
> > + if (local->flags & MEDIA_PAD_FL_SOURCE)
> > + return 0;
> > +
> > + dev_dbg(dev, "link setup '%s':%d->'%s':%d[%d]",
> > + remote->entity->name, remote->index, local->entity->name,
> > + local->index, flags & MEDIA_LNK_FL_ENABLED);
> > +
> > + /* Required for the fifo calculation */
> > + ctrl = v4l2_ctrl_find(sensor_sd->ctrl_handler, V4L2_CID_PIXEL_RATE);
> > + if (!ctrl) {
> > + dev_err(dev, "Subdev [%s] must support V4L2_CID_PIXEL_RATE\n",
> > + sensor_sd->name);
> > + return -EINVAL;
> > + }
> > + tc358746->sensor_pclk_ctrl = ctrl;
> > +
> > + return 0;
> > +}
> > +
> > +int __maybe_unused
> > +tc358746_g_register(struct v4l2_subdev *sd, struct v4l2_dbg_register *reg)
> > +{
> > + struct tc358746 *tc358746 = to_tc358746(sd);
> > +
> > + /* 32-bit registers starting from CLW_DPHYCONTTX */
> > + reg->size = reg->reg < CLW_DPHYCONTTX_REG ? 2 : 4;
> > +
> > + if (pm_runtime_resume_and_get(sd->dev)) {
> > + dev_err(sd->dev, "Failed to resume the device\n");
> > + return 0;
> > + }
> > +
> > + tc358746_read(tc358746, reg->reg, (u32 *)®->val);
> > +
> > + pm_runtime_mark_last_busy(sd->dev);
> > + pm_runtime_put_sync_autosuspend(sd->dev);
> > +
> > + return 0;
> > +}
> > +
> > +int __maybe_unused
> > +tc358746_s_register(struct v4l2_subdev *sd, const struct v4l2_dbg_register *reg)
> > +{
> > + struct tc358746 *tc358746 = to_tc358746(sd);
> > +
> > + if (pm_runtime_resume_and_get(sd->dev)) {
> > + dev_err(sd->dev, "Failed to resume the device\n");
> > + return 0;
> > + }
> > +
> > + tc358746_write(tc358746, (u32)reg->reg, (u32)reg->val);
> > +
> > + pm_runtime_mark_last_busy(sd->dev);
> > + pm_runtime_put_sync_autosuspend(sd->dev);
> > +
> > + return 0;
> > +}
> > +
> > +static const struct v4l2_subdev_core_ops tc358746_core_ops = {
> > +#ifdef CONFIG_VIDEO_ADV_DEBUG
> > + .g_register = tc358746_g_register,
> > + .s_register = tc358746_s_register,
> > +#endif
>
> Have you found this to be useful ?
It's useful since the regmap usage, because some registers are 32bit
wide and some 16bit wide... Those functions abstract it and I can set
values :) which is not allowed by the regmap debug interface. So yes,
it's not that bad..
> > +};
> > +
> > +static const struct v4l2_subdev_video_ops tc358746_video_ops = {
> > + .s_stream = tc358746_s_stream,
> > +};
> > +
> > +static const struct v4l2_subdev_pad_ops tc358746_pad_ops = {
> > + .enum_mbus_code = tc358746_enum_mbus_code,
> > + .set_fmt = tc358746_set_fmt,
> > + .get_fmt = tc358746_get_fmt,
> > + .link_validate = tc358746_link_validate,
> > + .get_mbus_config = tc358746_get_mbus_config,
> > +};
> > +
> > +static const struct v4l2_subdev_ops tc358746_ops = {
> > + .core = &tc358746_core_ops,
> > + .video = &tc358746_video_ops,
> > + .pad = &tc358746_pad_ops,
> > +};
> > +
> > +static const struct media_entity_operations tc358746_entity_ops = {
> > + .get_fwnode_pad = v4l2_subdev_get_fwnode_pad_1_to_1,
> > + .link_setup = tc358746_link_setup,
> > + .link_validate = v4l2_subdev_link_validate,
> > +};
> > +
> > +static int tc358746_mclk_enable(struct clk_hw *hw)
> > +{
> > + struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
> > + unsigned int div;
> > + u32 val;
> > + int err;
> > +
> > + div = tc358746->mclk_postdiv / 2;
> > + val = MCLK_HIGH(div - 1) | MCLK_LOW(div - 1);
> > + dev_dbg(tc358746->sd.dev, "MCLKCTL: %u (0x%x)\n", val, val);
> > + err = tc358746_write(tc358746, MCLKCTL_REG, val);
> > + if (err)
> > + return err;
> > +
> > + if (tc358746->mclk_prediv == 8)
> > + val = MCLKDIV(MCLKDIV_8);
> > + else if (tc358746->mclk_prediv == 4)
> > + val = MCLKDIV(MCLKDIV_4);
> > + else
> > + val = MCLKDIV(MCLKDIV_2);
> > +
> > + dev_dbg(tc358746->sd.dev, "CLKCTL[MCLKDIV]: %u (0x%x)\n", val, val);
> > + return tc358746_update_bits(tc358746, CLKCTL_REG, MCLKDIV_MASK, val);
> > +}
> > +
> > +static void tc358746_mclk_disable(struct clk_hw *hw)
> > +{
> > + struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
> > +
> > + tc358746_write(tc358746, MCLKCTL_REG, 0);
> > +}
> > +
> > +static long
> > +tc358746_find_mclk_settings(struct tc358746 *tc358746, unsigned long mclk_rate)
> > +{
> > + unsigned long pll_rate = tc358746->pll_rate;
> > + const unsigned char prediv[] = { 2, 4, 8 };
> > + unsigned int mclk_prediv, mclk_postdiv;
> > + struct device *dev = tc358746->sd.dev;
> > + unsigned int postdiv, mclkdiv;
> > + unsigned long best_mclk_rate;
> > + unsigned int i;
> > +
> > + /*
> > + * MCLK-Div
> > + * -------------------´`---------------------
> > + * ´ `
> > + * +-------------+ +------------------------+
> > + * | MCLK-PreDiv | | MCLK-PostDiv |
> > + * PLL --> | (2/4/8) | --> | (mclk_low + mclk_high) | --> MCLK
> > + * +-------------+ +------------------------+
> > + *
> > + * The register value of mclk_low/high is mclk_low/high+1, i.e.:
> > + * mclk_low/high = 1 --> 2 MCLK-Ref Counts
> > + * mclk_low/high = 255 --> 256 MCLK-Ref Counts == max.
> > + * If mclk_low and mclk_high are 0 then MCLK is disabled.
> > + *
> > + * Keep it simple and support 50/50 duty cycles only for now,
> > + * so the calc will be:
> > + *
> > + * MCLK = PLL / (MCLK-PreDiv * 2 * MCLK-PostDiv)
> > + */
> > +
> > + if (mclk_rate == tc358746->mclk_rate)
> > + return mclk_rate;
> > +
> > + /* Highest possible rate */
> > + mclkdiv = pll_rate / mclk_rate;
> > + if (mclkdiv <= 8) {
> > + mclk_prediv = 2;
> > + mclk_postdiv = 4;
> > + best_mclk_rate = pll_rate / (2 * 4);
> > + goto out;
> > + }
> > +
> > + /* First check the prediv */
> > + for (i = 0; i < ARRAY_SIZE(prediv); i++) {
> > + postdiv = mclkdiv / prediv[i];
> > +
> > + if (postdiv % 2)
> > + continue;
> > +
> > + if (postdiv >= 4 && postdiv <= 512) {
> > + mclk_prediv = prediv[i];
> > + mclk_postdiv = postdiv;
> > + best_mclk_rate = pll_rate / (prediv[i] * postdiv);
> > + goto out;
> > + }
> > + }
> > +
> > + /* No suitable prediv found, so try to adjust the postdiv */
> > + for (postdiv = 4; postdiv <= 512; postdiv += 2) {
> > + unsigned int pre;
> > +
> > + pre = mclkdiv / postdiv;
> > + if (pre == 2 || pre == 4 || pre == 8) {
> > + mclk_prediv = pre;
> > + mclk_postdiv = postdiv;
> > + best_mclk_rate = pll_rate / (pre * postdiv);
> > + goto out;
> > + }
> > + }
> > +
> > + /* The MCLK <-> PLL gap is to high -> use largest possible div */
> > + mclk_prediv = 8;
> > + mclk_postdiv = 512;
> > + best_mclk_rate = pll_rate / (8 * 512);
> > +
> > +out:
> > + tc358746->mclk_prediv = mclk_prediv;
> > + tc358746->mclk_postdiv = mclk_postdiv;
> > + tc358746->mclk_rate = best_mclk_rate;
> > +
> > + if (best_mclk_rate != mclk_rate)
> > + dev_warn(dev, "Request MCLK freq:%lu, found MCLK freq:%lu\n",
> > + mclk_rate, best_mclk_rate);
> > +
> > + dev_dbg(dev, "Found MCLK settings: freq:%lu prediv:%u postdiv:%u\n",
> > + best_mclk_rate, mclk_prediv, mclk_postdiv);
> > +
> > + return best_mclk_rate;
> > +}
> > +
> > +unsigned long tc358746_recalc_rate(struct clk_hw *hw, unsigned long parent_rate)
> > +{
> > + struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
> > + unsigned int prediv, postdiv;
> > + u32 val;
> > + int err;
> > +
> > + err = tc358746_read(tc358746, MCLKCTL_REG, &val);
> > + if (err)
> > + return 0;
> > +
> > + postdiv = FIELD_GET(MCLK_LOW_MASK, val) + 1;
> > + postdiv += FIELD_GET(MCLK_HIGH_MASK, val) + 1;
> > +
> > + err = tc358746_read(tc358746, CLKCTL_REG, &val);
> > + if (err)
> > + return 0;
> > +
> > + prediv = FIELD_GET(MCLKDIV_MASK, val);
> > + if (prediv == MCLKDIV_8)
> > + prediv = 8;
> > + else if (prediv == MCLKDIV_4)
> > + prediv = 4;
> > + else
> > + prediv = 2;
> > +
> > + return tc358746->pll_rate / (prediv * postdiv);
> > +}
> > +
> > +static long tc358746_mclk_round_rate(struct clk_hw *hw, unsigned long rate,
> > + unsigned long *parent_rate)
> > +{
> > + struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
> > +
> > + *parent_rate = tc358746->pll_rate;
> > +
> > + return tc358746_find_mclk_settings(tc358746, rate);
> > +}
> > +
> > +static int tc358746_mclk_set_rate(struct clk_hw *hw, unsigned long rate,
> > + unsigned long parent_rate)
> > +{
> > + struct tc358746 *tc358746 = clk_hw_to_tc358746(hw);
> > +
> > + tc358746_find_mclk_settings(tc358746, rate);
> > +
> > + return tc358746_mclk_enable(hw);
> > +}
> > +
> > +static const struct clk_ops tc358746_mclk_ops = {
> > + .enable = tc358746_mclk_enable,
> > + .disable = tc358746_mclk_disable,
> > + .recalc_rate = tc358746_recalc_rate,
> > + .round_rate = tc358746_mclk_round_rate,
> > + .set_rate = tc358746_mclk_set_rate,
> > +};
> > +
> > +static int tc358746_notify_bound(struct v4l2_async_notifier *notifier,
> > + struct v4l2_subdev *sd,
> > + struct v4l2_async_subdev *asd)
> > +{
> > + struct tc358746 *tc358746 =
> > + container_of(notifier, struct tc358746, notifier);
> > + struct media_pad *sink = &tc358746->pads[TC358746_SINK];
> > +
> > + return v4l2_create_fwnode_links_to_pad(sd, sink, MEDIA_LNK_FL_ENABLED);
> > +}
> > +
> > +static const struct v4l2_async_notifier_operations tc358746_notify_ops = {
> > + .bound = tc358746_notify_bound,
> > +};
> > +
> > +static int tc358746_async_register(struct tc358746 *tc358746)
> > +{
> > + struct v4l2_fwnode_endpoint vep = {
> > + .bus_type = V4L2_MBUS_PARALLEL,
> > + };
> > + struct v4l2_async_subdev *asd;
> > + struct fwnode_handle *ep;
> > + int err;
> > +
> > + ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(tc358746->sd.dev),
> > + TC358746_SINK, 0, 0);
> > + if (!ep)
> > + return -ENOTCONN;
> > +
> > + err = v4l2_fwnode_endpoint_parse(ep, &vep);
> > + if (err) {
> > + fwnode_handle_put(ep);
> > + return err;
> > + }
> > +
> > + v4l2_async_nf_init(&tc358746->notifier);
> > + asd = v4l2_async_nf_add_fwnode_remote(&tc358746->notifier, ep,
> > + struct v4l2_async_subdev);
> > + if (IS_ERR(asd)) {
> > + fwnode_handle_put(ep);
> > + return PTR_ERR(asd);
> > + }
> > +
> > + fwnode_handle_put(ep);
> > +
> > + tc358746->notifier.ops = &tc358746_notify_ops;
> > +
> > + err = v4l2_async_subdev_nf_register(&tc358746->sd, &tc358746->notifier);
> > + if (err) {
> > + v4l2_async_nf_cleanup(&tc358746->notifier);
> > + return err;
> > + }
> > +
> > + tc358746->sd.fwnode = fwnode_graph_get_endpoint_by_id(
> > + dev_fwnode(tc358746->sd.dev), TC358746_SOURCE, 0, 0);
> > +
> > + err = v4l2_async_register_subdev(&tc358746->sd);
> > + if (err) {
> > + v4l2_async_nf_unregister(&tc358746->notifier);
> > + v4l2_async_nf_cleanup(&tc358746->notifier);
> > + }
> > +
> > + return err;
> > +}
> > +
> > +static int tc358746_probe(struct i2c_client *client)
> > +{
> > + struct clk_init_data mclk_initdata = { };
> > + struct device *dev = &client->dev;
> > + struct v4l2_fwnode_endpoint *vep;
> > + unsigned long csi_link_rate;
> > + struct tc358746 *tc358746;
> > + struct fwnode_handle *ep;
> > + unsigned char csi_lanes;
> > + struct v4l2_subdev *sd;
> > + struct v4l2_ctrl *ctrl;
> > + unsigned long refclk;
> > + unsigned int i;
> > + int err;
> > + u32 val;
> > +
> > + tc358746 = devm_kzalloc(&client->dev, sizeof(*tc358746), GFP_KERNEL);
> > + if (!tc358746)
> > + return -ENOMEM;
> > +
> > + tc358746->regmap = devm_regmap_init_i2c(client, &tc358746_regmap_config);
> > + if (IS_ERR(tc358746->regmap))
> > + return dev_err_probe(dev, PTR_ERR(tc358746->regmap),
> > + "Failed to init regmap\n");
> > +
> > + tc358746->refclk = devm_clk_get(dev, "refclk");
> > + if (IS_ERR(tc358746->refclk))
> > + return dev_err_probe(dev, PTR_ERR(tc358746->refclk),
> > + "Failed to get refclk\n");
> > +
> > + err = clk_prepare_enable(tc358746->refclk);
> > + if (err)
> > + return dev_err_probe(dev, err,
> > + "Failed to enable refclk\n");
> > +
> > + refclk = clk_get_rate(tc358746->refclk);
> > + clk_disable_unprepare(tc358746->refclk);
> > +
> > + if (refclk < 6 * MHZ || refclk > 40 * MHZ)
> > + return dev_err_probe(dev, -EINVAL, "Invalid refclk range\n");
> > +
> > + for (i = 0; i < ARRAY_SIZE(tc358746_supplies); i++)
> > + tc358746->supplies[i].supply = tc358746_supplies[i];
> > +
> > + err = devm_regulator_bulk_get(dev, ARRAY_SIZE(tc358746_supplies),
> > + tc358746->supplies);
> > + if (err)
> > + return dev_err_probe(dev, err, "Failed to get supplies\n");
> > +
> > + tc358746->reset_gpio = devm_gpiod_get_optional(dev, "reset",
> > + GPIOD_OUT_HIGH);
> > + if (IS_ERR(tc358746->reset_gpio))
> > + return dev_err_probe(dev, PTR_ERR(tc358746->reset_gpio),
> > + "Failed to get reset-gpios\n");
> > +
> > + sd = &tc358746->sd;
> > + v4l2_i2c_subdev_init(sd, client, &tc358746_ops);
> > + sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
> > + sd->entity.function = MEDIA_ENT_F_VID_IF_BRIDGE;
> > + sd->entity.ops = &tc358746_entity_ops;
> > +
> > + tc358746->pads[TC358746_SINK].flags = MEDIA_PAD_FL_SINK;
> > + tc358746->pads[TC358746_SOURCE].flags = MEDIA_PAD_FL_SOURCE;
> > + err = media_entity_pads_init(&sd->entity, TC358746_NR_PADS,
> > + tc358746->pads);
> > + if (err)
> > + return dev_err_probe(dev, err,
> > + "Failed to setup media-entity pads\n");
> > +
> > + ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(dev), TC358746_SOURCE,
> > + 0, 0);
> > + if (!ep) {
> > + dev_err(dev, "Missing endpoint node\n");
> > + err = -EINVAL;
> > + goto err_mc;
> > + }
> > +
> > + /* Currently we only support 'parallel in' -> 'csi out' */
> > + vep = &tc358746->csi_vep;
> > + vep->bus_type = V4L2_MBUS_CSI2_DPHY;
> > + err = v4l2_fwnode_endpoint_alloc_parse(ep, vep);
> > + fwnode_handle_put(ep);
> > + if (err) {
> > + dev_err(dev, "Failed to parse source endpoint\n");
> > + goto err_mc;
> > + }
> > +
> > + csi_lanes = vep->bus.mipi_csi2.num_data_lanes;
> > + if (csi_lanes == 0 || csi_lanes > 4 ||
> > + vep->nr_of_link_frequencies == 0) {
> > + dev_err(dev, "error: Invalid CSI-2 settings\n");
> > + err = -EINVAL;
> > + goto err_vep;
> > + }
> > +
> > + /* TODO: Add support to handle multiple link frequencies */
> > + csi_link_rate = (unsigned long)vep->link_frequencies[0];
> > + tc358746->pll_rate = tc358746_find_pll_settings(tc358746, refclk,
> > + csi_link_rate * 2);
> > + if (!tc358746->pll_rate) {
> > + err = -EINVAL;
> > + goto err_vep;
> > + }
> > +
> > + err = phy_mipi_dphy_get_default_config_for_hsclk(tc358746->pll_rate,
> > + csi_lanes,
> > + &tc358746->dphy_cfg);
> > + if (err)
> > + goto err_vep;
> > +
> > + tc358746->mbusfmt = tc358746_def_fmt;
> > + tc358746->vb_size = TC358746_VB_DEFAULT_SIZE;
> > +
> > + dev_set_drvdata(dev, tc358746);
> > + pm_runtime_set_autosuspend_delay(dev, 200);
> > + pm_runtime_use_autosuspend(dev);
> > + pm_runtime_enable(dev);
> > +
> > + err = pm_runtime_resume_and_get(dev);
> > + if (err < 0) {
> > + dev_err(dev, "Failed to resume the device\n");
> > + goto err_vep;
> > + }
> > +
> > + /* Ensure that CSI interface is put into LP-11 state */
> > + err = tc358746_sw_reset(tc358746);
> > + if (err) {
> > + pm_runtime_put_noidle(dev);
> > + dev_err(dev, "Failed to reset the device\n");
> > + goto err_pm;
> > + }
> > +
> > + err = tc358746_read(tc358746, CHIPID_REG, &val);
> > + pm_runtime_mark_last_busy(dev);
> > + pm_runtime_put_sync_autosuspend(dev);
> > + if (err) {
> > + dev_err(dev, "Failed to read chipid\n");
> > + err = -ENODEV;
> > + goto err_pm;
> > + }
> > +
> > + if (FIELD_GET(CHIPID, val) != 0x44) {
> > + dev_err(dev, "Invalid chipid 0x%02x\n",
> > + (u32)FIELD_GET(CHIPID, val));
> > + err = -ENODEV;
> > + goto err_pm;
> > + }
> > +
> > + /* Optional MCLK provider support */
> > + if (device_property_present(dev, "#clock-cells")) {
> > + const char *mclk_name;
> > +
> > + /* Init to highest possibel MCLK */
> > + tc358746->mclk_postdiv = 512;
> > + tc358746->mclk_prediv = 8;
> > +
> > + mclk_name = "tc358746-mclk";
> > + device_property_read_string(dev, "clock-output-names",
> > + &mclk_name);
> > +
> > + mclk_initdata.name = mclk_name;
> > + mclk_initdata.ops = &tc358746_mclk_ops;
> > + tc358746->mclk_hw.init = &mclk_initdata;
> > +
> > + err = devm_clk_hw_register(dev, &tc358746->mclk_hw);
> > + if (err) {
> > + dev_err(dev, "Failed to register mclk provider\n");
> > + goto err_pm;
> > + }
> > +
> > + err = devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get,
> > + &tc358746->mclk_hw);
> > + if (err) {
> > + dev_err(dev, "Failed to add mclk provider\n");
> > + goto err_pm;
> > + }
> > + }
> > +
> > + v4l2_ctrl_handler_init(&tc358746->ctrl_hdl, 1);
> > +
> > + ctrl = v4l2_ctrl_new_int_menu(&tc358746->ctrl_hdl, NULL,
> > + V4L2_CID_LINK_FREQ, 0, 0,
> > + vep->link_frequencies);
> > + if (ctrl)
> > + ctrl->flags |= V4L2_CTRL_FLAG_READ_ONLY;
> > +
> > + tc358746->sd.ctrl_handler = &tc358746->ctrl_hdl;
> > + if (tc358746->ctrl_hdl.error) {
> > + err = tc358746->ctrl_hdl.error;
> > + goto err_pm;
> > + }
> > +
> > + v4l2_ctrl_handler_setup(&tc358746->ctrl_hdl);
> > +
> > + err = tc358746_async_register(tc358746);
> > + if (err < 0)
> > + goto err_ctrl;
> > +
> > + dev_info(dev, "%s found @ 0x%x (%s)\n", client->name,
> > + client->addr, client->adapter->name);
>
> I'd skip this to avoid adding noise to the kernel log at boot time. I
> would also probably split some of the code out of the probe function as
> it's fairly large. Up to you.
Yes it is large but most of it is just requesting stuff and so..
Therefore I kept it here since I don't need it elsewhere. What about
setting it to dev_dbg()? Sometimes it can be useful e.g. to find the
problem why /dev/media is not comming up..
> > +
> > + return 0;
> > +
> > +err_ctrl:
> > + v4l2_ctrl_handler_free(&tc358746->ctrl_hdl);
> > +err_pm:
> > + pm_runtime_disable(dev);
> > + pm_runtime_set_suspended(dev);
> > + pm_runtime_dont_use_autosuspend(dev);
> > +err_vep:
> > + v4l2_fwnode_endpoint_free(vep);
> > +err_mc:
> > + media_entity_cleanup(&sd->entity);
> > +
> > + return err;
> > +}
> > +
> > +static int tc358746_remove(struct i2c_client *client)
> > +{
> > + struct v4l2_subdev *sd = i2c_get_clientdata(client);
> > + struct tc358746 *tc358746 = to_tc358746(sd);
> > +
> > + v4l2_ctrl_handler_free(&tc358746->ctrl_hdl);
> > + v4l2_fwnode_endpoint_free(&tc358746->csi_vep);
> > + v4l2_async_nf_unregister(&tc358746->notifier);
> > + v4l2_async_nf_cleanup(&tc358746->notifier);
> > + v4l2_async_unregister_subdev(sd);
> > + v4l2_device_unregister_subdev(sd);
>
> This shouldn't be needed v4l2_async_unregister_subdev() should be
> enough.
Okay, thanks. There are a lot of unregister helpers in the v4l2 space..
>
> > + media_entity_cleanup(&sd->entity);
> > +
> > + pm_runtime_disable(sd->dev);
> > + pm_runtime_set_suspended(sd->dev);
> > + pm_runtime_dont_use_autosuspend(sd->dev);
> > +
> > + return 0;
> > +}
> > +
> > +static int tc358746_suspend(struct device *dev)
> > +{
> > + struct tc358746 *tc358746 = dev_get_drvdata(dev);
> > +
> > + clk_disable_unprepare(tc358746->refclk);
> > +
> > + return regulator_bulk_disable(ARRAY_SIZE(tc358746_supplies),
> > + tc358746->supplies);
>
> Shouldn't you reenable the clock if this fails ?
Hm.. if this fails I could end in a undefined chip state. But I got the
point that the framework would be in a bad state if it tries again to
suspend the device.
> > +}
> > +
> > +static int tc358746_resume(struct device *dev)
> > +{
> > + struct tc358746 *tc358746 = dev_get_drvdata(dev);
> > + int err;
> > +
> > + gpiod_set_value(tc358746->reset_gpio, 1);
> > +
> > + err = regulator_bulk_enable(ARRAY_SIZE(tc358746_supplies),
> > + tc358746->supplies);
> > + if (err)
> > + return err;
> > +
> > + /* min. 200ns */
> > + usleep_range(10, 20);
> > +
> > + gpiod_set_value(tc358746->reset_gpio, 0);
> > +
> > + err = clk_prepare_enable(tc358746->refclk);
> > + if (err)
> > + return err;
>
> The regulators need to be disabled in case of failure here and below
> (and so does the clock below).
Yes, you're right.
> > +
> > + /* min. 700us ... 1ms */
> > + usleep_range(1000, 1500);
> > +
> > + /* Sync state */
> > + err = tc358746_apply_pll_config(tc358746);
> > + if (err)
> > + return err;
> > +
> > + err = tc358746_apply_dphy_config(tc358746);
> > + if (err)
> > + return err;
> > +
> > + return tc358746_apply_misc_config(tc358746);
>
> Does all this belong to the PM resume handler ? It seems configuration
> could be handled in .s_stream() instead.
This gets called by the s_stream() during getting the power state but I
can move the dphy/misc_config to the .s_stream() of course. The pll
needs to be there since the device can be a clock provider e.g. for the
sensor.
Thanks for the review :)
Regards,
Marco
> > +}
> > +
> > +DEFINE_RUNTIME_DEV_PM_OPS(tc358746_pm_ops, tc358746_suspend,
> > + tc358746_resume, NULL);
> > +
> > +static const struct of_device_id __maybe_unused tc358746_of_match[] = {
> > + { .compatible = "toshiba,tc358746" },
> > + { },
> > +};
> > +MODULE_DEVICE_TABLE(of, tc358746_of_match);
> > +
> > +static struct i2c_driver tc358746_driver = {
> > + .driver = {
> > + .name = "tc358746",
> > + .pm = pm_ptr(&tc358746_pm_ops),
> > + .of_match_table = tc358746_of_match,
> > + },
> > + .probe_new = tc358746_probe,
> > + .remove = tc358746_remove,
> > +};
> > +
> > +module_i2c_driver(tc358746_driver);
> > +
> > +MODULE_DESCRIPTION("Toshiba TC358746 Parallel to CSI-2 bridge driver");
> > +MODULE_AUTHOR("Marco Felsch <kernel@pengutronix.de>");
> > +MODULE_LICENSE("GPL");
>
> --
> Regards,
>
> Laurent Pinchart
>
--
linux-phy mailing list
linux-phy@lists.infradead.org
https://lists.infradead.org/mailman/listinfo/linux-phy
^ permalink raw reply [flat|nested] 34+ messages in thread
* Re: [PATCH 3/4] media: dt-bindings: add bindings for Toshiba TC358746
2022-09-15 13:19 ` Marco Felsch
@ 2022-09-16 13:57 ` Laurent Pinchart
-1 siblings, 0 replies; 34+ messages in thread
From: Laurent Pinchart @ 2022-09-16 13:57 UTC (permalink / raw)
To: Marco Felsch
Cc: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, linux-kernel, linux-phy,
devicetree, linux-media, kernel
Hi Marco,
On Thu, Sep 15, 2022 at 03:19:33PM +0200, Marco Felsch wrote:
> On 22-09-05, Laurent Pinchart wrote:
> > On Thu, Aug 18, 2022 at 04:33:06PM +0200, Marco Felsch wrote:
> > > Add the bindings for the Toshiba TC358746 Parallel <-> MIPI-CSI bridge
> > > driver.
> > >
> > > Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
> > > ---
> > > .../bindings/media/i2c/toshiba,tc358746.yaml | 157 ++++++++++++++++++
> > > 1 file changed, 157 insertions(+)
> > > create mode 100644 Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
> > >
> > > diff --git a/Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml b/Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
> > > new file mode 100644
> > > index 000000000000..9783cca363c6
> > > --- /dev/null
> > > +++ b/Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
> > > @@ -0,0 +1,157 @@
> > > +# SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause)
> > > +%YAML 1.2
> > > +---
> > > +$id: http://devicetree.org/schemas/media/i2c/toshiba,tc358746.yaml#
> > > +$schema: http://devicetree.org/meta-schemas/core.yaml#
> > > +
> > > +title: Toshiba TC358746 Parallel to MIPI CSI2 Bridge
> > > +
> > > +maintainers:
> > > + - Marco Felsch <kernel@pengutronix.de>
> > > +
> > > +description: |-
> > > + The Toshiba TC358746 converts a parallel video stream into a MIPI CSI-2
> > > + stream. The direction can be either parallel-in -> csi-out or csi-in ->
> > > + parallel-out The chip is programmable trough I2C and SPI but the SPI
> > > + interface is only supported in parallel-in -> csi-out mode.
> > > +
> > > + Note that the current device tree bindings only support the
> > > + parallel-in -> csi-out path.
> > > +
> > > +properties:
> > > + compatible:
> > > + const: toshiba,tc358746
> > > +
> > > + reg:
> > > + maxItems: 1
> > > +
> > > + clocks:
> > > + description:
> > > + The phandle to the reference clock source. This corresponds to the
> > > + hardware pin REFCLK.
> > > + maxItems: 1
> > > +
> > > + clock-names:
> > > + const: refclk
> >
> > As there's a single clock, should we omit the clock name ?
>
> Don't know, I would rather keep it to make it explicite. Many other go
> that way too.
I don't mind either way.
> > > +# The bridge can act as clock provider for the sensor. To enable this support
> > > +# #clock-cells must be specified. Attention if this feature is used than the
> >
> > s/than/then/
>
> Sure, thanks.
>
> > > +# mclk rate must be at least: (2 * link-frequency) / 8
> > > +# `------------------´ ^
> > > +# internal PLL rate smallest possible mclk-div
> >
> > Could this be captured in the description of the property instead of a
> > comment ?
>
> Hm.. a few (1,2) bindings using comments like this but I'm not against
> it. If it belongs to the description, which property should I use? Since
> there is no: clock-controller property like gpio-controller or
> interrupt-controller. The clock provider will be activated based on the
> #clock-cells property. But this property has nothing to with the
> description since this property specifies the cell size.
I would have put it in the description of the #clock-cells property:
"#clock-cells":
description: |
The bridge can act as clock provider for the sensor. To enable
this support #clock-cells must be specified. Attention ...
const: 0
but if it becomes an issue, I'm OK with the comment too.
> > > + "#clock-cells":
> > > + const: 0
> > > +
> > > + clock-output-names:
> > > + description:
> > > + The clock name of the MCLK output, the default name is tc358746-mclk.
> > > + maxItems: 1
> > > +
> > > + vddc-supply:
> > > + description: Digital core voltage supply, 1.2 volts
> > > +
> > > + vddio-supply:
> > > + description: Digital I/O voltage supply, 1.8 volts
> > > +
> > > + vddmipi-supply:
> > > + description: MIPI CSI phy voltage supply, 1.2 volts
> > > +
> > > + reset-gpios:
> > > + description:
> > > + The phandle and specifier for the GPIO that controls the chip reset.
> > > + This corresponds to the hardware pin RESX which is physically active low.
> > > + maxItems: 1
> > > +
> > > + ports:
> > > + $ref: /schemas/graph.yaml#/properties/ports
> > > + properties:
> > > + port@0:
> > > + $ref: /schemas/graph.yaml#/properties/port
> > > + description: Input port
> >
> > Are the H/V sync signal polarities fixed, or should they be specified
> > here ?
>
> At the moment they are fixed.
If the hardware supports different polarities, let's add them to the
device tree binding, even if the driver only supports a single option at
the moment.
> I can describe it if you want.
Thanks.
> > Does the chip support external sync only, or also BT.656 ? In the
> > latter case this needs a bus-type.
>
> Yes, the chip also supports BT.656 but the driver doesn't support it
> yet. You're right, that we should make it explicite albeit it would a
> bit overhead yet since the only mode is: parallel-in with externa syncs.
Let's prepare for BT.656 support in the DT bindings, or we may regret it
later :-)
> > > +
> > > + port@1:
> > > + $ref: /schemas/graph.yaml#/$defs/port-base
> > > + description: Output port
> > > +
> > > + properties:
> > > + endpoint:
> > > + $ref: /schemas/media/video-interfaces.yaml#
> > > + unevaluatedProperties: false
> > > +
> > > + properties:
> > > + data-lanes:
> > > + minItems: 1
> > > + maxItems: 4
> > > +
> > > + clock-noncontinuous: true
> > > + link-frequencies: true
> > > +
> > > + required:
> > > + - data-lanes
> > > + - link-frequencies
> > > +
> > > + required:
> > > + - port@0
> > > + - port@1
> > > +
> > > +required:
> > > + - compatible
> > > + - reg
> > > + - clocks
> > > + - clock-names
> > > + - vddc-supply
> > > + - vddio-supply
> > > + - vddmipi-supply
> > > + - ports
> > > +
> > > +additionalProperties: false
> > > +
> > > +examples:
> > > + - |
> > > + #include <dt-bindings/gpio/gpio.h>
> > > +
> > > + i2c {
> > > + #address-cells = <1>;
> > > + #size-cells = <0>;
> > > +
> > > + csi-bridge@e {
> > > + compatible = "toshiba,tc358746";
> > > + reg = <0xe>;
> > > +
> > > + clocks = <&refclk>;
> > > + clock-names = "refclk";
> > > +
> > > + reset-gpios = <&gpio 2 GPIO_ACTIVE_LOW>;
> > > +
> > > + vddc-supply = <&v1_2d>;
> > > + vddio-supply = <&v1_8d>;
> > > + vddmipi-supply = <&v1_2d>;
> > > +
> > > + /* sensor mclk provider */
> > > + #clock-cells = <0>;
> > > +
> > > + ports {
> > > + #address-cells = <1>;
> > > + #size-cells = <0>;
> > > +
> > > + /* Input */
> > > + port@0 {
> > > + reg = <0>;
> > > + tc358746_in: endpoint {
> > > + remote-endpoint = <&sensor_out>;
> > > + };
> >
> > Wrong indentation here.
>
> Yes, thanks.
>
> > > + };
> > > +
> > > + /* Output */
> > > + port@1 {
> > > + reg = <1>;
> > > + tc358746_out: endpoint {
> > > + remote-endpoint = <&mipi_csi2_in>;
> > > + data-lanes = <1 2>;
> > > + clock-noncontinuous;
> > > + link-frequencies = /bits/ 64 <216000000>;
> > > + };
> > > + };
> > > + };
> > > + };
> > > + };
--
Regards,
Laurent Pinchart
^ permalink raw reply [flat|nested] 34+ messages in thread
* Re: [PATCH 3/4] media: dt-bindings: add bindings for Toshiba TC358746
@ 2022-09-16 13:57 ` Laurent Pinchart
0 siblings, 0 replies; 34+ messages in thread
From: Laurent Pinchart @ 2022-09-16 13:57 UTC (permalink / raw)
To: Marco Felsch
Cc: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, linux-kernel, linux-phy,
devicetree, linux-media, kernel
Hi Marco,
On Thu, Sep 15, 2022 at 03:19:33PM +0200, Marco Felsch wrote:
> On 22-09-05, Laurent Pinchart wrote:
> > On Thu, Aug 18, 2022 at 04:33:06PM +0200, Marco Felsch wrote:
> > > Add the bindings for the Toshiba TC358746 Parallel <-> MIPI-CSI bridge
> > > driver.
> > >
> > > Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
> > > ---
> > > .../bindings/media/i2c/toshiba,tc358746.yaml | 157 ++++++++++++++++++
> > > 1 file changed, 157 insertions(+)
> > > create mode 100644 Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
> > >
> > > diff --git a/Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml b/Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
> > > new file mode 100644
> > > index 000000000000..9783cca363c6
> > > --- /dev/null
> > > +++ b/Documentation/devicetree/bindings/media/i2c/toshiba,tc358746.yaml
> > > @@ -0,0 +1,157 @@
> > > +# SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause)
> > > +%YAML 1.2
> > > +---
> > > +$id: http://devicetree.org/schemas/media/i2c/toshiba,tc358746.yaml#
> > > +$schema: http://devicetree.org/meta-schemas/core.yaml#
> > > +
> > > +title: Toshiba TC358746 Parallel to MIPI CSI2 Bridge
> > > +
> > > +maintainers:
> > > + - Marco Felsch <kernel@pengutronix.de>
> > > +
> > > +description: |-
> > > + The Toshiba TC358746 converts a parallel video stream into a MIPI CSI-2
> > > + stream. The direction can be either parallel-in -> csi-out or csi-in ->
> > > + parallel-out The chip is programmable trough I2C and SPI but the SPI
> > > + interface is only supported in parallel-in -> csi-out mode.
> > > +
> > > + Note that the current device tree bindings only support the
> > > + parallel-in -> csi-out path.
> > > +
> > > +properties:
> > > + compatible:
> > > + const: toshiba,tc358746
> > > +
> > > + reg:
> > > + maxItems: 1
> > > +
> > > + clocks:
> > > + description:
> > > + The phandle to the reference clock source. This corresponds to the
> > > + hardware pin REFCLK.
> > > + maxItems: 1
> > > +
> > > + clock-names:
> > > + const: refclk
> >
> > As there's a single clock, should we omit the clock name ?
>
> Don't know, I would rather keep it to make it explicite. Many other go
> that way too.
I don't mind either way.
> > > +# The bridge can act as clock provider for the sensor. To enable this support
> > > +# #clock-cells must be specified. Attention if this feature is used than the
> >
> > s/than/then/
>
> Sure, thanks.
>
> > > +# mclk rate must be at least: (2 * link-frequency) / 8
> > > +# `------------------´ ^
> > > +# internal PLL rate smallest possible mclk-div
> >
> > Could this be captured in the description of the property instead of a
> > comment ?
>
> Hm.. a few (1,2) bindings using comments like this but I'm not against
> it. If it belongs to the description, which property should I use? Since
> there is no: clock-controller property like gpio-controller or
> interrupt-controller. The clock provider will be activated based on the
> #clock-cells property. But this property has nothing to with the
> description since this property specifies the cell size.
I would have put it in the description of the #clock-cells property:
"#clock-cells":
description: |
The bridge can act as clock provider for the sensor. To enable
this support #clock-cells must be specified. Attention ...
const: 0
but if it becomes an issue, I'm OK with the comment too.
> > > + "#clock-cells":
> > > + const: 0
> > > +
> > > + clock-output-names:
> > > + description:
> > > + The clock name of the MCLK output, the default name is tc358746-mclk.
> > > + maxItems: 1
> > > +
> > > + vddc-supply:
> > > + description: Digital core voltage supply, 1.2 volts
> > > +
> > > + vddio-supply:
> > > + description: Digital I/O voltage supply, 1.8 volts
> > > +
> > > + vddmipi-supply:
> > > + description: MIPI CSI phy voltage supply, 1.2 volts
> > > +
> > > + reset-gpios:
> > > + description:
> > > + The phandle and specifier for the GPIO that controls the chip reset.
> > > + This corresponds to the hardware pin RESX which is physically active low.
> > > + maxItems: 1
> > > +
> > > + ports:
> > > + $ref: /schemas/graph.yaml#/properties/ports
> > > + properties:
> > > + port@0:
> > > + $ref: /schemas/graph.yaml#/properties/port
> > > + description: Input port
> >
> > Are the H/V sync signal polarities fixed, or should they be specified
> > here ?
>
> At the moment they are fixed.
If the hardware supports different polarities, let's add them to the
device tree binding, even if the driver only supports a single option at
the moment.
> I can describe it if you want.
Thanks.
> > Does the chip support external sync only, or also BT.656 ? In the
> > latter case this needs a bus-type.
>
> Yes, the chip also supports BT.656 but the driver doesn't support it
> yet. You're right, that we should make it explicite albeit it would a
> bit overhead yet since the only mode is: parallel-in with externa syncs.
Let's prepare for BT.656 support in the DT bindings, or we may regret it
later :-)
> > > +
> > > + port@1:
> > > + $ref: /schemas/graph.yaml#/$defs/port-base
> > > + description: Output port
> > > +
> > > + properties:
> > > + endpoint:
> > > + $ref: /schemas/media/video-interfaces.yaml#
> > > + unevaluatedProperties: false
> > > +
> > > + properties:
> > > + data-lanes:
> > > + minItems: 1
> > > + maxItems: 4
> > > +
> > > + clock-noncontinuous: true
> > > + link-frequencies: true
> > > +
> > > + required:
> > > + - data-lanes
> > > + - link-frequencies
> > > +
> > > + required:
> > > + - port@0
> > > + - port@1
> > > +
> > > +required:
> > > + - compatible
> > > + - reg
> > > + - clocks
> > > + - clock-names
> > > + - vddc-supply
> > > + - vddio-supply
> > > + - vddmipi-supply
> > > + - ports
> > > +
> > > +additionalProperties: false
> > > +
> > > +examples:
> > > + - |
> > > + #include <dt-bindings/gpio/gpio.h>
> > > +
> > > + i2c {
> > > + #address-cells = <1>;
> > > + #size-cells = <0>;
> > > +
> > > + csi-bridge@e {
> > > + compatible = "toshiba,tc358746";
> > > + reg = <0xe>;
> > > +
> > > + clocks = <&refclk>;
> > > + clock-names = "refclk";
> > > +
> > > + reset-gpios = <&gpio 2 GPIO_ACTIVE_LOW>;
> > > +
> > > + vddc-supply = <&v1_2d>;
> > > + vddio-supply = <&v1_8d>;
> > > + vddmipi-supply = <&v1_2d>;
> > > +
> > > + /* sensor mclk provider */
> > > + #clock-cells = <0>;
> > > +
> > > + ports {
> > > + #address-cells = <1>;
> > > + #size-cells = <0>;
> > > +
> > > + /* Input */
> > > + port@0 {
> > > + reg = <0>;
> > > + tc358746_in: endpoint {
> > > + remote-endpoint = <&sensor_out>;
> > > + };
> >
> > Wrong indentation here.
>
> Yes, thanks.
>
> > > + };
> > > +
> > > + /* Output */
> > > + port@1 {
> > > + reg = <1>;
> > > + tc358746_out: endpoint {
> > > + remote-endpoint = <&mipi_csi2_in>;
> > > + data-lanes = <1 2>;
> > > + clock-noncontinuous;
> > > + link-frequencies = /bits/ 64 <216000000>;
> > > + };
> > > + };
> > > + };
> > > + };
> > > + };
--
Regards,
Laurent Pinchart
--
linux-phy mailing list
linux-phy@lists.infradead.org
https://lists.infradead.org/mailman/listinfo/linux-phy
^ permalink raw reply [flat|nested] 34+ messages in thread
* Re: [PATCH 4/4] media: tc358746: add Toshiba TC358746 Parallel to CSI-2 bridge driver
2022-09-15 16:54 ` Marco Felsch
@ 2022-09-16 14:33 ` Laurent Pinchart
-1 siblings, 0 replies; 34+ messages in thread
From: Laurent Pinchart @ 2022-09-16 14:33 UTC (permalink / raw)
To: Marco Felsch
Cc: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, linux-kernel, linux-phy,
devicetree, linux-media, kernel
Hi Marco,
On Thu, Sep 15, 2022 at 06:54:04PM +0200, Marco Felsch wrote:
> On 22-09-05, Laurent Pinchart wrote:
> > On Thu, Aug 18, 2022 at 04:33:07PM +0200, Marco Felsch wrote:
> > > Adding support for the TC358746 parallel <-> MIPI CSI bridge. This chip
> > > supports two operating modes:
> > > 1st) parallel-in -> mipi-csi out
> > > 2nd) mipi-csi in -> parallel out
> > >
> > > This patch only adds the support for the 1st mode.
> > >
> > > Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
> > > ---
> > > drivers/media/i2c/Kconfig | 17 +
> > > drivers/media/i2c/Makefile | 1 +
> > > drivers/media/i2c/tc358746.c | 1645 ++++++++++++++++++++++++++++++++++
> > > 3 files changed, 1663 insertions(+)
> > > create mode 100644 drivers/media/i2c/tc358746.c
[snip]
> > > diff --git a/drivers/media/i2c/tc358746.c b/drivers/media/i2c/tc358746.c
> > > new file mode 100644
> > > index 000000000000..7b71d0cf72a9
> > > --- /dev/null
> > > +++ b/drivers/media/i2c/tc358746.c
[snip]
> > > +struct tc358746 {
> > > + struct v4l2_subdev sd;
> > > + struct media_pad pads[TC358746_NR_PADS];
> > > + struct v4l2_async_notifier notifier;
> > > + struct v4l2_mbus_framefmt mbusfmt;
> >
> > Could you use the active state API instead of manually storing mbusfmt
> > here ? It involves
>
> I will do that, thanks for the hint and it also elimates a few basic
> checks like the pad-num check.
Even nicer :-)
> > - Implementing the .init_cfg() operation
> > - Calling v4l2_subdev_init_finalize() in probe
> > - Replacing calls to __tc358746_get_pad_format() with
> > v4l2_subdev_get_pad_format()
> > - Propagating the format from sink to source in tc358746_set_fmt()
> > - Dropping tc358746_src_mbus_code() from tc358746_get_fmt() and simply
> > retrieving the format using v4l2_subdev_get_pad_format() there
> > - Dropping this field
> >
> > The formats for both the ACTIVE and TRY states will then be stored in
> > the subdev state, unconditionally. You can retrieve the active state
> > with v4l2_subdev_get_locked_active_state() in tc358746_s_stream().
> >
> > > + struct v4l2_fwnode_endpoint csi_vep;
> > > +
> > > + struct v4l2_ctrl_handler ctrl_hdl;
> > > +
> > > + struct regmap *regmap;
> > > + struct clk *refclk;
> > > + struct gpio_desc *reset_gpio;
> > > + struct regulator_bulk_data supplies[ARRAY_SIZE(tc358746_supplies)];
> > > +
> > > + struct clk_hw mclk_hw;
> > > + unsigned long mclk_rate;
> > > + u8 mclk_prediv;
> > > + u16 mclk_postdiv;
> > > +
> > > + unsigned long pll_rate;
> > > + u8 pll_post_div;
> > > + u16 pll_pre_div;
> > > + u16 pll_mul;
> > > +
> > > + struct v4l2_ctrl *sensor_pclk_ctrl;
> > > +
> > > +#define TC358746_VB_MAX_SIZE (511 * 32)
> > > +#define TC358746_VB_DEFAULT_SIZE (1 * 32)
> > > + unsigned int vb_size; /* Video buffer size in bits */
> > > +
> > > + struct phy_configure_opts_mipi_dphy dphy_cfg;
> > > +};
[snip]
> > > +#ifndef MHZ
> >
> > Where would it be previously defined ? This sounds like asking for
> > trouble later.
>
> Sorry I don't get that, do you mean that I should define it at the very
> beginning?
I mean that either MHZ is defined somewhere in the kernel already, in
case we should include the corresponding header, or it's not, and I
wouldn't add an #ifndev here. Otherwise, if someone adds a MHZ macro
later that gets pulled in through one of the kernel headers used by the
driver, it may cause subtle bugs if the definition is different. Of
course nobody will
#define MHZ 42
but we could get
#define MHZ 1000 * 1000
and something could break here. I'd drop the #ifndef to get the compiler
to complain if there's a redefinition.
> > > +#define MHZ (1000 * 1000)
> > > +#endif
[snip]
> > > +static int
> > > +tc358746_link_validate(struct v4l2_subdev *sd, struct media_link *link,
> > > + struct v4l2_subdev_format *source_fmt,
> > > + struct v4l2_subdev_format *sink_fmt)
> > > +{
> > > + struct tc358746 *tc358746 = to_tc358746(sd);
> > > + unsigned long csi_bitrate, sensor_bitrate;
> > > + const struct tc358746_format *fmt;
> > > + unsigned int fifo_sz, tmp, n;
> > > + s64 sensor_pclk_rate;
> > > +
> > > + /* Check the FIFO settings */
> > > + fmt = tc358746_get_format_by_code(TC358746_SINK, tc358746->mbusfmt.code);
> > > + if (IS_ERR(fmt))
> > > + return PTR_ERR(fmt);
> > > +
> > > + sensor_pclk_rate = v4l2_ctrl_g_ctrl_int64(tc358746->sensor_pclk_ctrl);
> > > + sensor_bitrate = sensor_pclk_rate * fmt->bus_width;
> > > +
> > > + csi_bitrate = tc358746->dphy_cfg.lanes * tc358746->pll_rate;
> > > +
> > > + dev_dbg(tc358746->sd.dev,
> > > + "Fifo settings params: sensor-bitrate:%lu csi-bitrate:%lu",
> > > + sensor_bitrate, csi_bitrate);
> > > +
> > > + /* Avoid possible FIFO overflows */
> > > + if (csi_bitrate < sensor_bitrate) {
> > > + dev_err(sd->dev,
> > > + "Link validation failed csi-bitrate:%lu < sensor-bitrate:%lu\n",
> > > + csi_bitrate, sensor_bitrate);
> > > + return -EINVAL;
> > > + }
> > > +
> > > + /* Best case */
> > > + if (csi_bitrate == sensor_bitrate) {
> > > + tc358746->vb_size = TC358746_VB_DEFAULT_SIZE;
> > > + goto out;
> > > + }
> > > +
> > > + /*
> > > + * Avoid possible FIFO underflow in case of
> > > + * csi_bitrate > sensor_bitrate. For such case the chip has a internal
> > > + * fifo which can be used to delay the line output.
> > > + *
> > > + * Fifo size calculation:
> > > + *
> > > + * fifo-sz, image-width - in bits
> > > + * sbr - sensor_bitrate in bits/s
> > > + * csir - csi_bitrate in bits/s
> > > + *
> > > + * 1 1 1
> > > + * image-width * --- + fifo-sz --- >= ---- * image-width
> > > + * sbr sbr csir
> > > + *
> > > + * fifo-sz >= abs(sbr/csir * image-width - image-width)
> > > + * `-----´
> > > + * n
> > > + *
> > > + */
> > > +
> > > + sensor_bitrate /= TC358746_PRECISION;
> > > + n = csi_bitrate / sensor_bitrate;
> > > + tmp = (tc358746->mbusfmt.width * TC358746_PRECISION) / n;
> > > + fifo_sz = tc358746->mbusfmt.width - tmp;
> > > + fifo_sz *= fmt->bpp;
> > > + tc358746->vb_size = round_up(fifo_sz, 32);
> > > +
> >
> > Please also call v4l2_subdev_link_validate_default() here.
>
> Did it in my internal prepared v2 ^^ I call it now at the very
> beginning of this function.
>
> > I wonder if the above calculation wouldn't be better performed in
> > .s_stream() (or rather in a function being called by .s_stream()) when
> > enabling streaming.
>
> No I wouldn't shift that, since the link validation is in IMHO the
> correct place to inform the user that the pipeline can't negotiate if
> the fifo can't be configured correctly. Therefore I placed it here.
The issue is that the user could enable the link first, and then change
the V4L2_CID_LINK_FREQ of the sensor and push the pixel rate above what
the TC358746 can support. Given the model that configures subdevs
independently, you can only validate the pipeline at stream on time.
> > > +out:
> > > + dev_dbg(tc358746->sd.dev,
> > > + "Found FIFO size[bits]:%u -> aligned to size[bits]:%u\n",
> > > + fifo_sz, tc358746->vb_size);
> > > +
> > > + return tc358746->vb_size > TC358746_VB_MAX_SIZE ? -EINVAL : 0;
> > > +}
[snip]
> > > +static int tc358746_probe(struct i2c_client *client)
> > > +{
> > > + struct clk_init_data mclk_initdata = { };
> > > + struct device *dev = &client->dev;
> > > + struct v4l2_fwnode_endpoint *vep;
> > > + unsigned long csi_link_rate;
> > > + struct tc358746 *tc358746;
> > > + struct fwnode_handle *ep;
> > > + unsigned char csi_lanes;
> > > + struct v4l2_subdev *sd;
> > > + struct v4l2_ctrl *ctrl;
> > > + unsigned long refclk;
> > > + unsigned int i;
> > > + int err;
> > > + u32 val;
> > > +
> > > + tc358746 = devm_kzalloc(&client->dev, sizeof(*tc358746), GFP_KERNEL);
> > > + if (!tc358746)
> > > + return -ENOMEM;
> > > +
> > > + tc358746->regmap = devm_regmap_init_i2c(client, &tc358746_regmap_config);
> > > + if (IS_ERR(tc358746->regmap))
> > > + return dev_err_probe(dev, PTR_ERR(tc358746->regmap),
> > > + "Failed to init regmap\n");
> > > +
> > > + tc358746->refclk = devm_clk_get(dev, "refclk");
> > > + if (IS_ERR(tc358746->refclk))
> > > + return dev_err_probe(dev, PTR_ERR(tc358746->refclk),
> > > + "Failed to get refclk\n");
> > > +
> > > + err = clk_prepare_enable(tc358746->refclk);
> > > + if (err)
> > > + return dev_err_probe(dev, err,
> > > + "Failed to enable refclk\n");
> > > +
> > > + refclk = clk_get_rate(tc358746->refclk);
> > > + clk_disable_unprepare(tc358746->refclk);
> > > +
> > > + if (refclk < 6 * MHZ || refclk > 40 * MHZ)
> > > + return dev_err_probe(dev, -EINVAL, "Invalid refclk range\n");
> > > +
> > > + for (i = 0; i < ARRAY_SIZE(tc358746_supplies); i++)
> > > + tc358746->supplies[i].supply = tc358746_supplies[i];
> > > +
> > > + err = devm_regulator_bulk_get(dev, ARRAY_SIZE(tc358746_supplies),
> > > + tc358746->supplies);
> > > + if (err)
> > > + return dev_err_probe(dev, err, "Failed to get supplies\n");
> > > +
> > > + tc358746->reset_gpio = devm_gpiod_get_optional(dev, "reset",
> > > + GPIOD_OUT_HIGH);
> > > + if (IS_ERR(tc358746->reset_gpio))
> > > + return dev_err_probe(dev, PTR_ERR(tc358746->reset_gpio),
> > > + "Failed to get reset-gpios\n");
> > > +
> > > + sd = &tc358746->sd;
> > > + v4l2_i2c_subdev_init(sd, client, &tc358746_ops);
> > > + sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
> > > + sd->entity.function = MEDIA_ENT_F_VID_IF_BRIDGE;
> > > + sd->entity.ops = &tc358746_entity_ops;
> > > +
> > > + tc358746->pads[TC358746_SINK].flags = MEDIA_PAD_FL_SINK;
> > > + tc358746->pads[TC358746_SOURCE].flags = MEDIA_PAD_FL_SOURCE;
> > > + err = media_entity_pads_init(&sd->entity, TC358746_NR_PADS,
> > > + tc358746->pads);
> > > + if (err)
> > > + return dev_err_probe(dev, err,
> > > + "Failed to setup media-entity pads\n");
> > > +
> > > + ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(dev), TC358746_SOURCE,
> > > + 0, 0);
> > > + if (!ep) {
> > > + dev_err(dev, "Missing endpoint node\n");
> > > + err = -EINVAL;
> > > + goto err_mc;
> > > + }
> > > +
> > > + /* Currently we only support 'parallel in' -> 'csi out' */
> > > + vep = &tc358746->csi_vep;
> > > + vep->bus_type = V4L2_MBUS_CSI2_DPHY;
> > > + err = v4l2_fwnode_endpoint_alloc_parse(ep, vep);
> > > + fwnode_handle_put(ep);
> > > + if (err) {
> > > + dev_err(dev, "Failed to parse source endpoint\n");
> > > + goto err_mc;
> > > + }
> > > +
> > > + csi_lanes = vep->bus.mipi_csi2.num_data_lanes;
> > > + if (csi_lanes == 0 || csi_lanes > 4 ||
> > > + vep->nr_of_link_frequencies == 0) {
> > > + dev_err(dev, "error: Invalid CSI-2 settings\n");
> > > + err = -EINVAL;
> > > + goto err_vep;
> > > + }
> > > +
> > > + /* TODO: Add support to handle multiple link frequencies */
> > > + csi_link_rate = (unsigned long)vep->link_frequencies[0];
> > > + tc358746->pll_rate = tc358746_find_pll_settings(tc358746, refclk,
> > > + csi_link_rate * 2);
> > > + if (!tc358746->pll_rate) {
> > > + err = -EINVAL;
> > > + goto err_vep;
> > > + }
> > > +
> > > + err = phy_mipi_dphy_get_default_config_for_hsclk(tc358746->pll_rate,
> > > + csi_lanes,
> > > + &tc358746->dphy_cfg);
> > > + if (err)
> > > + goto err_vep;
> > > +
> > > + tc358746->mbusfmt = tc358746_def_fmt;
> > > + tc358746->vb_size = TC358746_VB_DEFAULT_SIZE;
> > > +
> > > + dev_set_drvdata(dev, tc358746);
> > > + pm_runtime_set_autosuspend_delay(dev, 200);
> > > + pm_runtime_use_autosuspend(dev);
> > > + pm_runtime_enable(dev);
> > > +
> > > + err = pm_runtime_resume_and_get(dev);
> > > + if (err < 0) {
> > > + dev_err(dev, "Failed to resume the device\n");
> > > + goto err_vep;
> > > + }
> > > +
> > > + /* Ensure that CSI interface is put into LP-11 state */
> > > + err = tc358746_sw_reset(tc358746);
> > > + if (err) {
> > > + pm_runtime_put_noidle(dev);
> > > + dev_err(dev, "Failed to reset the device\n");
> > > + goto err_pm;
> > > + }
> > > +
> > > + err = tc358746_read(tc358746, CHIPID_REG, &val);
> > > + pm_runtime_mark_last_busy(dev);
> > > + pm_runtime_put_sync_autosuspend(dev);
> > > + if (err) {
> > > + dev_err(dev, "Failed to read chipid\n");
> > > + err = -ENODEV;
> > > + goto err_pm;
> > > + }
> > > +
> > > + if (FIELD_GET(CHIPID, val) != 0x44) {
> > > + dev_err(dev, "Invalid chipid 0x%02x\n",
> > > + (u32)FIELD_GET(CHIPID, val));
> > > + err = -ENODEV;
> > > + goto err_pm;
> > > + }
> > > +
> > > + /* Optional MCLK provider support */
> > > + if (device_property_present(dev, "#clock-cells")) {
> > > + const char *mclk_name;
> > > +
> > > + /* Init to highest possibel MCLK */
> > > + tc358746->mclk_postdiv = 512;
> > > + tc358746->mclk_prediv = 8;
> > > +
> > > + mclk_name = "tc358746-mclk";
> > > + device_property_read_string(dev, "clock-output-names",
> > > + &mclk_name);
> > > +
> > > + mclk_initdata.name = mclk_name;
> > > + mclk_initdata.ops = &tc358746_mclk_ops;
> > > + tc358746->mclk_hw.init = &mclk_initdata;
> > > +
> > > + err = devm_clk_hw_register(dev, &tc358746->mclk_hw);
> > > + if (err) {
> > > + dev_err(dev, "Failed to register mclk provider\n");
> > > + goto err_pm;
> > > + }
> > > +
> > > + err = devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get,
> > > + &tc358746->mclk_hw);
> > > + if (err) {
> > > + dev_err(dev, "Failed to add mclk provider\n");
> > > + goto err_pm;
> > > + }
> > > + }
> > > +
> > > + v4l2_ctrl_handler_init(&tc358746->ctrl_hdl, 1);
> > > +
> > > + ctrl = v4l2_ctrl_new_int_menu(&tc358746->ctrl_hdl, NULL,
> > > + V4L2_CID_LINK_FREQ, 0, 0,
> > > + vep->link_frequencies);
> > > + if (ctrl)
> > > + ctrl->flags |= V4L2_CTRL_FLAG_READ_ONLY;
> > > +
> > > + tc358746->sd.ctrl_handler = &tc358746->ctrl_hdl;
> > > + if (tc358746->ctrl_hdl.error) {
> > > + err = tc358746->ctrl_hdl.error;
> > > + goto err_pm;
> > > + }
> > > +
> > > + v4l2_ctrl_handler_setup(&tc358746->ctrl_hdl);
> > > +
> > > + err = tc358746_async_register(tc358746);
> > > + if (err < 0)
> > > + goto err_ctrl;
> > > +
> > > + dev_info(dev, "%s found @ 0x%x (%s)\n", client->name,
> > > + client->addr, client->adapter->name);
> >
> > I'd skip this to avoid adding noise to the kernel log at boot time. I
> > would also probably split some of the code out of the probe function as
> > it's fairly large. Up to you.
>
> Yes it is large but most of it is just requesting stuff and so..
> Therefore I kept it here since I don't need it elsewhere. What about
> setting it to dev_dbg()? Sometimes it can be useful e.g. to find the
> problem why /dev/media is not comming up..
I find that enabling dev_dbg() messages from drivers/base/dd.c are
helpful for that, but a dev_dbg() message here is fine too.
> > > +
> > > + return 0;
> > > +
> > > +err_ctrl:
> > > + v4l2_ctrl_handler_free(&tc358746->ctrl_hdl);
> > > +err_pm:
> > > + pm_runtime_disable(dev);
> > > + pm_runtime_set_suspended(dev);
> > > + pm_runtime_dont_use_autosuspend(dev);
> > > +err_vep:
> > > + v4l2_fwnode_endpoint_free(vep);
> > > +err_mc:
> > > + media_entity_cleanup(&sd->entity);
> > > +
> > > + return err;
> > > +}
> > > +
> > > +static int tc358746_remove(struct i2c_client *client)
> > > +{
> > > + struct v4l2_subdev *sd = i2c_get_clientdata(client);
> > > + struct tc358746 *tc358746 = to_tc358746(sd);
> > > +
> > > + v4l2_ctrl_handler_free(&tc358746->ctrl_hdl);
> > > + v4l2_fwnode_endpoint_free(&tc358746->csi_vep);
> > > + v4l2_async_nf_unregister(&tc358746->notifier);
> > > + v4l2_async_nf_cleanup(&tc358746->notifier);
> > > + v4l2_async_unregister_subdev(sd);
> > > + v4l2_device_unregister_subdev(sd);
> >
> > This shouldn't be needed v4l2_async_unregister_subdev() should be
> > enough.
>
> Okay, thanks. There are a lot of unregister helpers in the v4l2 space..
Too many of them indeed. I'd like to simplify all that.
> > > + media_entity_cleanup(&sd->entity);
> > > +
> > > + pm_runtime_disable(sd->dev);
> > > + pm_runtime_set_suspended(sd->dev);
> > > + pm_runtime_dont_use_autosuspend(sd->dev);
> > > +
> > > + return 0;
> > > +}
> > > +
> > > +static int tc358746_suspend(struct device *dev)
> > > +{
> > > + struct tc358746 *tc358746 = dev_get_drvdata(dev);
> > > +
> > > + clk_disable_unprepare(tc358746->refclk);
> > > +
> > > + return regulator_bulk_disable(ARRAY_SIZE(tc358746_supplies),
> > > + tc358746->supplies);
> >
> > Shouldn't you reenable the clock if this fails ?
>
> Hm.. if this fails I could end in a undefined chip state. But I got the
> point that the framework would be in a bad state if it tries again to
> suspend the device.
It would be, and without a way to recover, so that could be an issue.
> > > +}
> > > +
> > > +static int tc358746_resume(struct device *dev)
> > > +{
> > > + struct tc358746 *tc358746 = dev_get_drvdata(dev);
> > > + int err;
> > > +
> > > + gpiod_set_value(tc358746->reset_gpio, 1);
> > > +
> > > + err = regulator_bulk_enable(ARRAY_SIZE(tc358746_supplies),
> > > + tc358746->supplies);
> > > + if (err)
> > > + return err;
> > > +
> > > + /* min. 200ns */
> > > + usleep_range(10, 20);
> > > +
> > > + gpiod_set_value(tc358746->reset_gpio, 0);
> > > +
> > > + err = clk_prepare_enable(tc358746->refclk);
> > > + if (err)
> > > + return err;
> >
> > The regulators need to be disabled in case of failure here and below
> > (and so does the clock below).
>
> Yes, you're right.
>
> > > +
> > > + /* min. 700us ... 1ms */
> > > + usleep_range(1000, 1500);
> > > +
> > > + /* Sync state */
> > > + err = tc358746_apply_pll_config(tc358746);
> > > + if (err)
> > > + return err;
> > > +
> > > + err = tc358746_apply_dphy_config(tc358746);
> > > + if (err)
> > > + return err;
> > > +
> > > + return tc358746_apply_misc_config(tc358746);
> >
> > Does all this belong to the PM resume handler ? It seems configuration
> > could be handled in .s_stream() instead.
>
> This gets called by the s_stream() during getting the power state but I
> can move the dphy/misc_config to the .s_stream() of course.
That would be nice, thanks.
> The pll
> needs to be there since the device can be a clock provider e.g. for the
> sensor.
OK.
> Thanks for the review :)
>
> > > +}
> > > +
> > > +DEFINE_RUNTIME_DEV_PM_OPS(tc358746_pm_ops, tc358746_suspend,
> > > + tc358746_resume, NULL);
> > > +
> > > +static const struct of_device_id __maybe_unused tc358746_of_match[] = {
> > > + { .compatible = "toshiba,tc358746" },
> > > + { },
> > > +};
> > > +MODULE_DEVICE_TABLE(of, tc358746_of_match);
> > > +
> > > +static struct i2c_driver tc358746_driver = {
> > > + .driver = {
> > > + .name = "tc358746",
> > > + .pm = pm_ptr(&tc358746_pm_ops),
> > > + .of_match_table = tc358746_of_match,
> > > + },
> > > + .probe_new = tc358746_probe,
> > > + .remove = tc358746_remove,
> > > +};
> > > +
> > > +module_i2c_driver(tc358746_driver);
> > > +
> > > +MODULE_DESCRIPTION("Toshiba TC358746 Parallel to CSI-2 bridge driver");
> > > +MODULE_AUTHOR("Marco Felsch <kernel@pengutronix.de>");
> > > +MODULE_LICENSE("GPL");
--
Regards,
Laurent Pinchart
^ permalink raw reply [flat|nested] 34+ messages in thread
* Re: [PATCH 4/4] media: tc358746: add Toshiba TC358746 Parallel to CSI-2 bridge driver
@ 2022-09-16 14:33 ` Laurent Pinchart
0 siblings, 0 replies; 34+ messages in thread
From: Laurent Pinchart @ 2022-09-16 14:33 UTC (permalink / raw)
To: Marco Felsch
Cc: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, linux-kernel, linux-phy,
devicetree, linux-media, kernel
Hi Marco,
On Thu, Sep 15, 2022 at 06:54:04PM +0200, Marco Felsch wrote:
> On 22-09-05, Laurent Pinchart wrote:
> > On Thu, Aug 18, 2022 at 04:33:07PM +0200, Marco Felsch wrote:
> > > Adding support for the TC358746 parallel <-> MIPI CSI bridge. This chip
> > > supports two operating modes:
> > > 1st) parallel-in -> mipi-csi out
> > > 2nd) mipi-csi in -> parallel out
> > >
> > > This patch only adds the support for the 1st mode.
> > >
> > > Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
> > > ---
> > > drivers/media/i2c/Kconfig | 17 +
> > > drivers/media/i2c/Makefile | 1 +
> > > drivers/media/i2c/tc358746.c | 1645 ++++++++++++++++++++++++++++++++++
> > > 3 files changed, 1663 insertions(+)
> > > create mode 100644 drivers/media/i2c/tc358746.c
[snip]
> > > diff --git a/drivers/media/i2c/tc358746.c b/drivers/media/i2c/tc358746.c
> > > new file mode 100644
> > > index 000000000000..7b71d0cf72a9
> > > --- /dev/null
> > > +++ b/drivers/media/i2c/tc358746.c
[snip]
> > > +struct tc358746 {
> > > + struct v4l2_subdev sd;
> > > + struct media_pad pads[TC358746_NR_PADS];
> > > + struct v4l2_async_notifier notifier;
> > > + struct v4l2_mbus_framefmt mbusfmt;
> >
> > Could you use the active state API instead of manually storing mbusfmt
> > here ? It involves
>
> I will do that, thanks for the hint and it also elimates a few basic
> checks like the pad-num check.
Even nicer :-)
> > - Implementing the .init_cfg() operation
> > - Calling v4l2_subdev_init_finalize() in probe
> > - Replacing calls to __tc358746_get_pad_format() with
> > v4l2_subdev_get_pad_format()
> > - Propagating the format from sink to source in tc358746_set_fmt()
> > - Dropping tc358746_src_mbus_code() from tc358746_get_fmt() and simply
> > retrieving the format using v4l2_subdev_get_pad_format() there
> > - Dropping this field
> >
> > The formats for both the ACTIVE and TRY states will then be stored in
> > the subdev state, unconditionally. You can retrieve the active state
> > with v4l2_subdev_get_locked_active_state() in tc358746_s_stream().
> >
> > > + struct v4l2_fwnode_endpoint csi_vep;
> > > +
> > > + struct v4l2_ctrl_handler ctrl_hdl;
> > > +
> > > + struct regmap *regmap;
> > > + struct clk *refclk;
> > > + struct gpio_desc *reset_gpio;
> > > + struct regulator_bulk_data supplies[ARRAY_SIZE(tc358746_supplies)];
> > > +
> > > + struct clk_hw mclk_hw;
> > > + unsigned long mclk_rate;
> > > + u8 mclk_prediv;
> > > + u16 mclk_postdiv;
> > > +
> > > + unsigned long pll_rate;
> > > + u8 pll_post_div;
> > > + u16 pll_pre_div;
> > > + u16 pll_mul;
> > > +
> > > + struct v4l2_ctrl *sensor_pclk_ctrl;
> > > +
> > > +#define TC358746_VB_MAX_SIZE (511 * 32)
> > > +#define TC358746_VB_DEFAULT_SIZE (1 * 32)
> > > + unsigned int vb_size; /* Video buffer size in bits */
> > > +
> > > + struct phy_configure_opts_mipi_dphy dphy_cfg;
> > > +};
[snip]
> > > +#ifndef MHZ
> >
> > Where would it be previously defined ? This sounds like asking for
> > trouble later.
>
> Sorry I don't get that, do you mean that I should define it at the very
> beginning?
I mean that either MHZ is defined somewhere in the kernel already, in
case we should include the corresponding header, or it's not, and I
wouldn't add an #ifndev here. Otherwise, if someone adds a MHZ macro
later that gets pulled in through one of the kernel headers used by the
driver, it may cause subtle bugs if the definition is different. Of
course nobody will
#define MHZ 42
but we could get
#define MHZ 1000 * 1000
and something could break here. I'd drop the #ifndef to get the compiler
to complain if there's a redefinition.
> > > +#define MHZ (1000 * 1000)
> > > +#endif
[snip]
> > > +static int
> > > +tc358746_link_validate(struct v4l2_subdev *sd, struct media_link *link,
> > > + struct v4l2_subdev_format *source_fmt,
> > > + struct v4l2_subdev_format *sink_fmt)
> > > +{
> > > + struct tc358746 *tc358746 = to_tc358746(sd);
> > > + unsigned long csi_bitrate, sensor_bitrate;
> > > + const struct tc358746_format *fmt;
> > > + unsigned int fifo_sz, tmp, n;
> > > + s64 sensor_pclk_rate;
> > > +
> > > + /* Check the FIFO settings */
> > > + fmt = tc358746_get_format_by_code(TC358746_SINK, tc358746->mbusfmt.code);
> > > + if (IS_ERR(fmt))
> > > + return PTR_ERR(fmt);
> > > +
> > > + sensor_pclk_rate = v4l2_ctrl_g_ctrl_int64(tc358746->sensor_pclk_ctrl);
> > > + sensor_bitrate = sensor_pclk_rate * fmt->bus_width;
> > > +
> > > + csi_bitrate = tc358746->dphy_cfg.lanes * tc358746->pll_rate;
> > > +
> > > + dev_dbg(tc358746->sd.dev,
> > > + "Fifo settings params: sensor-bitrate:%lu csi-bitrate:%lu",
> > > + sensor_bitrate, csi_bitrate);
> > > +
> > > + /* Avoid possible FIFO overflows */
> > > + if (csi_bitrate < sensor_bitrate) {
> > > + dev_err(sd->dev,
> > > + "Link validation failed csi-bitrate:%lu < sensor-bitrate:%lu\n",
> > > + csi_bitrate, sensor_bitrate);
> > > + return -EINVAL;
> > > + }
> > > +
> > > + /* Best case */
> > > + if (csi_bitrate == sensor_bitrate) {
> > > + tc358746->vb_size = TC358746_VB_DEFAULT_SIZE;
> > > + goto out;
> > > + }
> > > +
> > > + /*
> > > + * Avoid possible FIFO underflow in case of
> > > + * csi_bitrate > sensor_bitrate. For such case the chip has a internal
> > > + * fifo which can be used to delay the line output.
> > > + *
> > > + * Fifo size calculation:
> > > + *
> > > + * fifo-sz, image-width - in bits
> > > + * sbr - sensor_bitrate in bits/s
> > > + * csir - csi_bitrate in bits/s
> > > + *
> > > + * 1 1 1
> > > + * image-width * --- + fifo-sz --- >= ---- * image-width
> > > + * sbr sbr csir
> > > + *
> > > + * fifo-sz >= abs(sbr/csir * image-width - image-width)
> > > + * `-----´
> > > + * n
> > > + *
> > > + */
> > > +
> > > + sensor_bitrate /= TC358746_PRECISION;
> > > + n = csi_bitrate / sensor_bitrate;
> > > + tmp = (tc358746->mbusfmt.width * TC358746_PRECISION) / n;
> > > + fifo_sz = tc358746->mbusfmt.width - tmp;
> > > + fifo_sz *= fmt->bpp;
> > > + tc358746->vb_size = round_up(fifo_sz, 32);
> > > +
> >
> > Please also call v4l2_subdev_link_validate_default() here.
>
> Did it in my internal prepared v2 ^^ I call it now at the very
> beginning of this function.
>
> > I wonder if the above calculation wouldn't be better performed in
> > .s_stream() (or rather in a function being called by .s_stream()) when
> > enabling streaming.
>
> No I wouldn't shift that, since the link validation is in IMHO the
> correct place to inform the user that the pipeline can't negotiate if
> the fifo can't be configured correctly. Therefore I placed it here.
The issue is that the user could enable the link first, and then change
the V4L2_CID_LINK_FREQ of the sensor and push the pixel rate above what
the TC358746 can support. Given the model that configures subdevs
independently, you can only validate the pipeline at stream on time.
> > > +out:
> > > + dev_dbg(tc358746->sd.dev,
> > > + "Found FIFO size[bits]:%u -> aligned to size[bits]:%u\n",
> > > + fifo_sz, tc358746->vb_size);
> > > +
> > > + return tc358746->vb_size > TC358746_VB_MAX_SIZE ? -EINVAL : 0;
> > > +}
[snip]
> > > +static int tc358746_probe(struct i2c_client *client)
> > > +{
> > > + struct clk_init_data mclk_initdata = { };
> > > + struct device *dev = &client->dev;
> > > + struct v4l2_fwnode_endpoint *vep;
> > > + unsigned long csi_link_rate;
> > > + struct tc358746 *tc358746;
> > > + struct fwnode_handle *ep;
> > > + unsigned char csi_lanes;
> > > + struct v4l2_subdev *sd;
> > > + struct v4l2_ctrl *ctrl;
> > > + unsigned long refclk;
> > > + unsigned int i;
> > > + int err;
> > > + u32 val;
> > > +
> > > + tc358746 = devm_kzalloc(&client->dev, sizeof(*tc358746), GFP_KERNEL);
> > > + if (!tc358746)
> > > + return -ENOMEM;
> > > +
> > > + tc358746->regmap = devm_regmap_init_i2c(client, &tc358746_regmap_config);
> > > + if (IS_ERR(tc358746->regmap))
> > > + return dev_err_probe(dev, PTR_ERR(tc358746->regmap),
> > > + "Failed to init regmap\n");
> > > +
> > > + tc358746->refclk = devm_clk_get(dev, "refclk");
> > > + if (IS_ERR(tc358746->refclk))
> > > + return dev_err_probe(dev, PTR_ERR(tc358746->refclk),
> > > + "Failed to get refclk\n");
> > > +
> > > + err = clk_prepare_enable(tc358746->refclk);
> > > + if (err)
> > > + return dev_err_probe(dev, err,
> > > + "Failed to enable refclk\n");
> > > +
> > > + refclk = clk_get_rate(tc358746->refclk);
> > > + clk_disable_unprepare(tc358746->refclk);
> > > +
> > > + if (refclk < 6 * MHZ || refclk > 40 * MHZ)
> > > + return dev_err_probe(dev, -EINVAL, "Invalid refclk range\n");
> > > +
> > > + for (i = 0; i < ARRAY_SIZE(tc358746_supplies); i++)
> > > + tc358746->supplies[i].supply = tc358746_supplies[i];
> > > +
> > > + err = devm_regulator_bulk_get(dev, ARRAY_SIZE(tc358746_supplies),
> > > + tc358746->supplies);
> > > + if (err)
> > > + return dev_err_probe(dev, err, "Failed to get supplies\n");
> > > +
> > > + tc358746->reset_gpio = devm_gpiod_get_optional(dev, "reset",
> > > + GPIOD_OUT_HIGH);
> > > + if (IS_ERR(tc358746->reset_gpio))
> > > + return dev_err_probe(dev, PTR_ERR(tc358746->reset_gpio),
> > > + "Failed to get reset-gpios\n");
> > > +
> > > + sd = &tc358746->sd;
> > > + v4l2_i2c_subdev_init(sd, client, &tc358746_ops);
> > > + sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
> > > + sd->entity.function = MEDIA_ENT_F_VID_IF_BRIDGE;
> > > + sd->entity.ops = &tc358746_entity_ops;
> > > +
> > > + tc358746->pads[TC358746_SINK].flags = MEDIA_PAD_FL_SINK;
> > > + tc358746->pads[TC358746_SOURCE].flags = MEDIA_PAD_FL_SOURCE;
> > > + err = media_entity_pads_init(&sd->entity, TC358746_NR_PADS,
> > > + tc358746->pads);
> > > + if (err)
> > > + return dev_err_probe(dev, err,
> > > + "Failed to setup media-entity pads\n");
> > > +
> > > + ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(dev), TC358746_SOURCE,
> > > + 0, 0);
> > > + if (!ep) {
> > > + dev_err(dev, "Missing endpoint node\n");
> > > + err = -EINVAL;
> > > + goto err_mc;
> > > + }
> > > +
> > > + /* Currently we only support 'parallel in' -> 'csi out' */
> > > + vep = &tc358746->csi_vep;
> > > + vep->bus_type = V4L2_MBUS_CSI2_DPHY;
> > > + err = v4l2_fwnode_endpoint_alloc_parse(ep, vep);
> > > + fwnode_handle_put(ep);
> > > + if (err) {
> > > + dev_err(dev, "Failed to parse source endpoint\n");
> > > + goto err_mc;
> > > + }
> > > +
> > > + csi_lanes = vep->bus.mipi_csi2.num_data_lanes;
> > > + if (csi_lanes == 0 || csi_lanes > 4 ||
> > > + vep->nr_of_link_frequencies == 0) {
> > > + dev_err(dev, "error: Invalid CSI-2 settings\n");
> > > + err = -EINVAL;
> > > + goto err_vep;
> > > + }
> > > +
> > > + /* TODO: Add support to handle multiple link frequencies */
> > > + csi_link_rate = (unsigned long)vep->link_frequencies[0];
> > > + tc358746->pll_rate = tc358746_find_pll_settings(tc358746, refclk,
> > > + csi_link_rate * 2);
> > > + if (!tc358746->pll_rate) {
> > > + err = -EINVAL;
> > > + goto err_vep;
> > > + }
> > > +
> > > + err = phy_mipi_dphy_get_default_config_for_hsclk(tc358746->pll_rate,
> > > + csi_lanes,
> > > + &tc358746->dphy_cfg);
> > > + if (err)
> > > + goto err_vep;
> > > +
> > > + tc358746->mbusfmt = tc358746_def_fmt;
> > > + tc358746->vb_size = TC358746_VB_DEFAULT_SIZE;
> > > +
> > > + dev_set_drvdata(dev, tc358746);
> > > + pm_runtime_set_autosuspend_delay(dev, 200);
> > > + pm_runtime_use_autosuspend(dev);
> > > + pm_runtime_enable(dev);
> > > +
> > > + err = pm_runtime_resume_and_get(dev);
> > > + if (err < 0) {
> > > + dev_err(dev, "Failed to resume the device\n");
> > > + goto err_vep;
> > > + }
> > > +
> > > + /* Ensure that CSI interface is put into LP-11 state */
> > > + err = tc358746_sw_reset(tc358746);
> > > + if (err) {
> > > + pm_runtime_put_noidle(dev);
> > > + dev_err(dev, "Failed to reset the device\n");
> > > + goto err_pm;
> > > + }
> > > +
> > > + err = tc358746_read(tc358746, CHIPID_REG, &val);
> > > + pm_runtime_mark_last_busy(dev);
> > > + pm_runtime_put_sync_autosuspend(dev);
> > > + if (err) {
> > > + dev_err(dev, "Failed to read chipid\n");
> > > + err = -ENODEV;
> > > + goto err_pm;
> > > + }
> > > +
> > > + if (FIELD_GET(CHIPID, val) != 0x44) {
> > > + dev_err(dev, "Invalid chipid 0x%02x\n",
> > > + (u32)FIELD_GET(CHIPID, val));
> > > + err = -ENODEV;
> > > + goto err_pm;
> > > + }
> > > +
> > > + /* Optional MCLK provider support */
> > > + if (device_property_present(dev, "#clock-cells")) {
> > > + const char *mclk_name;
> > > +
> > > + /* Init to highest possibel MCLK */
> > > + tc358746->mclk_postdiv = 512;
> > > + tc358746->mclk_prediv = 8;
> > > +
> > > + mclk_name = "tc358746-mclk";
> > > + device_property_read_string(dev, "clock-output-names",
> > > + &mclk_name);
> > > +
> > > + mclk_initdata.name = mclk_name;
> > > + mclk_initdata.ops = &tc358746_mclk_ops;
> > > + tc358746->mclk_hw.init = &mclk_initdata;
> > > +
> > > + err = devm_clk_hw_register(dev, &tc358746->mclk_hw);
> > > + if (err) {
> > > + dev_err(dev, "Failed to register mclk provider\n");
> > > + goto err_pm;
> > > + }
> > > +
> > > + err = devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get,
> > > + &tc358746->mclk_hw);
> > > + if (err) {
> > > + dev_err(dev, "Failed to add mclk provider\n");
> > > + goto err_pm;
> > > + }
> > > + }
> > > +
> > > + v4l2_ctrl_handler_init(&tc358746->ctrl_hdl, 1);
> > > +
> > > + ctrl = v4l2_ctrl_new_int_menu(&tc358746->ctrl_hdl, NULL,
> > > + V4L2_CID_LINK_FREQ, 0, 0,
> > > + vep->link_frequencies);
> > > + if (ctrl)
> > > + ctrl->flags |= V4L2_CTRL_FLAG_READ_ONLY;
> > > +
> > > + tc358746->sd.ctrl_handler = &tc358746->ctrl_hdl;
> > > + if (tc358746->ctrl_hdl.error) {
> > > + err = tc358746->ctrl_hdl.error;
> > > + goto err_pm;
> > > + }
> > > +
> > > + v4l2_ctrl_handler_setup(&tc358746->ctrl_hdl);
> > > +
> > > + err = tc358746_async_register(tc358746);
> > > + if (err < 0)
> > > + goto err_ctrl;
> > > +
> > > + dev_info(dev, "%s found @ 0x%x (%s)\n", client->name,
> > > + client->addr, client->adapter->name);
> >
> > I'd skip this to avoid adding noise to the kernel log at boot time. I
> > would also probably split some of the code out of the probe function as
> > it's fairly large. Up to you.
>
> Yes it is large but most of it is just requesting stuff and so..
> Therefore I kept it here since I don't need it elsewhere. What about
> setting it to dev_dbg()? Sometimes it can be useful e.g. to find the
> problem why /dev/media is not comming up..
I find that enabling dev_dbg() messages from drivers/base/dd.c are
helpful for that, but a dev_dbg() message here is fine too.
> > > +
> > > + return 0;
> > > +
> > > +err_ctrl:
> > > + v4l2_ctrl_handler_free(&tc358746->ctrl_hdl);
> > > +err_pm:
> > > + pm_runtime_disable(dev);
> > > + pm_runtime_set_suspended(dev);
> > > + pm_runtime_dont_use_autosuspend(dev);
> > > +err_vep:
> > > + v4l2_fwnode_endpoint_free(vep);
> > > +err_mc:
> > > + media_entity_cleanup(&sd->entity);
> > > +
> > > + return err;
> > > +}
> > > +
> > > +static int tc358746_remove(struct i2c_client *client)
> > > +{
> > > + struct v4l2_subdev *sd = i2c_get_clientdata(client);
> > > + struct tc358746 *tc358746 = to_tc358746(sd);
> > > +
> > > + v4l2_ctrl_handler_free(&tc358746->ctrl_hdl);
> > > + v4l2_fwnode_endpoint_free(&tc358746->csi_vep);
> > > + v4l2_async_nf_unregister(&tc358746->notifier);
> > > + v4l2_async_nf_cleanup(&tc358746->notifier);
> > > + v4l2_async_unregister_subdev(sd);
> > > + v4l2_device_unregister_subdev(sd);
> >
> > This shouldn't be needed v4l2_async_unregister_subdev() should be
> > enough.
>
> Okay, thanks. There are a lot of unregister helpers in the v4l2 space..
Too many of them indeed. I'd like to simplify all that.
> > > + media_entity_cleanup(&sd->entity);
> > > +
> > > + pm_runtime_disable(sd->dev);
> > > + pm_runtime_set_suspended(sd->dev);
> > > + pm_runtime_dont_use_autosuspend(sd->dev);
> > > +
> > > + return 0;
> > > +}
> > > +
> > > +static int tc358746_suspend(struct device *dev)
> > > +{
> > > + struct tc358746 *tc358746 = dev_get_drvdata(dev);
> > > +
> > > + clk_disable_unprepare(tc358746->refclk);
> > > +
> > > + return regulator_bulk_disable(ARRAY_SIZE(tc358746_supplies),
> > > + tc358746->supplies);
> >
> > Shouldn't you reenable the clock if this fails ?
>
> Hm.. if this fails I could end in a undefined chip state. But I got the
> point that the framework would be in a bad state if it tries again to
> suspend the device.
It would be, and without a way to recover, so that could be an issue.
> > > +}
> > > +
> > > +static int tc358746_resume(struct device *dev)
> > > +{
> > > + struct tc358746 *tc358746 = dev_get_drvdata(dev);
> > > + int err;
> > > +
> > > + gpiod_set_value(tc358746->reset_gpio, 1);
> > > +
> > > + err = regulator_bulk_enable(ARRAY_SIZE(tc358746_supplies),
> > > + tc358746->supplies);
> > > + if (err)
> > > + return err;
> > > +
> > > + /* min. 200ns */
> > > + usleep_range(10, 20);
> > > +
> > > + gpiod_set_value(tc358746->reset_gpio, 0);
> > > +
> > > + err = clk_prepare_enable(tc358746->refclk);
> > > + if (err)
> > > + return err;
> >
> > The regulators need to be disabled in case of failure here and below
> > (and so does the clock below).
>
> Yes, you're right.
>
> > > +
> > > + /* min. 700us ... 1ms */
> > > + usleep_range(1000, 1500);
> > > +
> > > + /* Sync state */
> > > + err = tc358746_apply_pll_config(tc358746);
> > > + if (err)
> > > + return err;
> > > +
> > > + err = tc358746_apply_dphy_config(tc358746);
> > > + if (err)
> > > + return err;
> > > +
> > > + return tc358746_apply_misc_config(tc358746);
> >
> > Does all this belong to the PM resume handler ? It seems configuration
> > could be handled in .s_stream() instead.
>
> This gets called by the s_stream() during getting the power state but I
> can move the dphy/misc_config to the .s_stream() of course.
That would be nice, thanks.
> The pll
> needs to be there since the device can be a clock provider e.g. for the
> sensor.
OK.
> Thanks for the review :)
>
> > > +}
> > > +
> > > +DEFINE_RUNTIME_DEV_PM_OPS(tc358746_pm_ops, tc358746_suspend,
> > > + tc358746_resume, NULL);
> > > +
> > > +static const struct of_device_id __maybe_unused tc358746_of_match[] = {
> > > + { .compatible = "toshiba,tc358746" },
> > > + { },
> > > +};
> > > +MODULE_DEVICE_TABLE(of, tc358746_of_match);
> > > +
> > > +static struct i2c_driver tc358746_driver = {
> > > + .driver = {
> > > + .name = "tc358746",
> > > + .pm = pm_ptr(&tc358746_pm_ops),
> > > + .of_match_table = tc358746_of_match,
> > > + },
> > > + .probe_new = tc358746_probe,
> > > + .remove = tc358746_remove,
> > > +};
> > > +
> > > +module_i2c_driver(tc358746_driver);
> > > +
> > > +MODULE_DESCRIPTION("Toshiba TC358746 Parallel to CSI-2 bridge driver");
> > > +MODULE_AUTHOR("Marco Felsch <kernel@pengutronix.de>");
> > > +MODULE_LICENSE("GPL");
--
Regards,
Laurent Pinchart
--
linux-phy mailing list
linux-phy@lists.infradead.org
https://lists.infradead.org/mailman/listinfo/linux-phy
^ permalink raw reply [flat|nested] 34+ messages in thread
* Re: [PATCH 4/4] media: tc358746: add Toshiba TC358746 Parallel to CSI-2 bridge driver
2022-09-16 14:33 ` Laurent Pinchart
@ 2022-09-19 8:40 ` Marco Felsch
-1 siblings, 0 replies; 34+ messages in thread
From: Marco Felsch @ 2022-09-19 8:40 UTC (permalink / raw)
To: Laurent Pinchart
Cc: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, linux-kernel, linux-phy,
devicetree, linux-media, kernel
Hi Laurent,
On 22-09-16, Laurent Pinchart wrote:
> Hi Marco,
>
> On Thu, Sep 15, 2022 at 06:54:04PM +0200, Marco Felsch wrote:
> > On 22-09-05, Laurent Pinchart wrote:
> > > On Thu, Aug 18, 2022 at 04:33:07PM +0200, Marco Felsch wrote:
> > > > Adding support for the TC358746 parallel <-> MIPI CSI bridge. This chip
> > > > supports two operating modes:
> > > > 1st) parallel-in -> mipi-csi out
> > > > 2nd) mipi-csi in -> parallel out
> > > >
> > > > This patch only adds the support for the 1st mode.
> > > >
> > > > Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
> > > > ---
> > > > drivers/media/i2c/Kconfig | 17 +
> > > > drivers/media/i2c/Makefile | 1 +
> > > > drivers/media/i2c/tc358746.c | 1645 ++++++++++++++++++++++++++++++++++
> > > > 3 files changed, 1663 insertions(+)
> > > > create mode 100644 drivers/media/i2c/tc358746.c
>
> [snip]
>
> > > > diff --git a/drivers/media/i2c/tc358746.c b/drivers/media/i2c/tc358746.c
> > > > new file mode 100644
> > > > index 000000000000..7b71d0cf72a9
> > > > --- /dev/null
> > > > +++ b/drivers/media/i2c/tc358746.c
>
> [snip]
>
> > > > +struct tc358746 {
> > > > + struct v4l2_subdev sd;
> > > > + struct media_pad pads[TC358746_NR_PADS];
> > > > + struct v4l2_async_notifier notifier;
> > > > + struct v4l2_mbus_framefmt mbusfmt;
> > >
> > > Could you use the active state API instead of manually storing mbusfmt
> > > here ? It involves
> >
> > I will do that, thanks for the hint and it also elimates a few basic
> > checks like the pad-num check.
>
> Even nicer :-)
>
> > > - Implementing the .init_cfg() operation
> > > - Calling v4l2_subdev_init_finalize() in probe
> > > - Replacing calls to __tc358746_get_pad_format() with
> > > v4l2_subdev_get_pad_format()
> > > - Propagating the format from sink to source in tc358746_set_fmt()
> > > - Dropping tc358746_src_mbus_code() from tc358746_get_fmt() and simply
> > > retrieving the format using v4l2_subdev_get_pad_format() there
> > > - Dropping this field
> > >
> > > The formats for both the ACTIVE and TRY states will then be stored in
> > > the subdev state, unconditionally. You can retrieve the active state
> > > with v4l2_subdev_get_locked_active_state() in tc358746_s_stream().
> > >
> > > > + struct v4l2_fwnode_endpoint csi_vep;
> > > > +
> > > > + struct v4l2_ctrl_handler ctrl_hdl;
> > > > +
> > > > + struct regmap *regmap;
> > > > + struct clk *refclk;
> > > > + struct gpio_desc *reset_gpio;
> > > > + struct regulator_bulk_data supplies[ARRAY_SIZE(tc358746_supplies)];
> > > > +
> > > > + struct clk_hw mclk_hw;
> > > > + unsigned long mclk_rate;
> > > > + u8 mclk_prediv;
> > > > + u16 mclk_postdiv;
> > > > +
> > > > + unsigned long pll_rate;
> > > > + u8 pll_post_div;
> > > > + u16 pll_pre_div;
> > > > + u16 pll_mul;
> > > > +
> > > > + struct v4l2_ctrl *sensor_pclk_ctrl;
> > > > +
> > > > +#define TC358746_VB_MAX_SIZE (511 * 32)
> > > > +#define TC358746_VB_DEFAULT_SIZE (1 * 32)
> > > > + unsigned int vb_size; /* Video buffer size in bits */
> > > > +
> > > > + struct phy_configure_opts_mipi_dphy dphy_cfg;
> > > > +};
>
> [snip]
>
> > > > +#ifndef MHZ
> > >
> > > Where would it be previously defined ? This sounds like asking for
> > > trouble later.
> >
> > Sorry I don't get that, do you mean that I should define it at the very
> > beginning?
>
> I mean that either MHZ is defined somewhere in the kernel already, in
> case we should include the corresponding header, or it's not, and I
> wouldn't add an #ifndev here. Otherwise, if someone adds a MHZ macro
> later that gets pulled in through one of the kernel headers used by the
> driver, it may cause subtle bugs if the definition is different. Of
> course nobody will
>
> #define MHZ 42
>
> but we could get
>
> #define MHZ 1000 * 1000
>
> and something could break here. I'd drop the #ifndef to get the compiler
> to complain if there's a redefinition.
Argh.. sorry, now I see what you meant. I have read it like "I'm asking
for troubles" because I'm defining it. Didn't saw that your comment was
only related to the ifndef guard, sure I can drop it.
> > > > +#define MHZ (1000 * 1000)
> > > > +#endif
>
> [snip]
>
> > > > +static int
> > > > +tc358746_link_validate(struct v4l2_subdev *sd, struct media_link *link,
> > > > + struct v4l2_subdev_format *source_fmt,
> > > > + struct v4l2_subdev_format *sink_fmt)
> > > > +{
> > > > + struct tc358746 *tc358746 = to_tc358746(sd);
> > > > + unsigned long csi_bitrate, sensor_bitrate;
> > > > + const struct tc358746_format *fmt;
> > > > + unsigned int fifo_sz, tmp, n;
> > > > + s64 sensor_pclk_rate;
> > > > +
> > > > + /* Check the FIFO settings */
> > > > + fmt = tc358746_get_format_by_code(TC358746_SINK, tc358746->mbusfmt.code);
> > > > + if (IS_ERR(fmt))
> > > > + return PTR_ERR(fmt);
> > > > +
> > > > + sensor_pclk_rate = v4l2_ctrl_g_ctrl_int64(tc358746->sensor_pclk_ctrl);
> > > > + sensor_bitrate = sensor_pclk_rate * fmt->bus_width;
> > > > +
> > > > + csi_bitrate = tc358746->dphy_cfg.lanes * tc358746->pll_rate;
> > > > +
> > > > + dev_dbg(tc358746->sd.dev,
> > > > + "Fifo settings params: sensor-bitrate:%lu csi-bitrate:%lu",
> > > > + sensor_bitrate, csi_bitrate);
> > > > +
> > > > + /* Avoid possible FIFO overflows */
> > > > + if (csi_bitrate < sensor_bitrate) {
> > > > + dev_err(sd->dev,
> > > > + "Link validation failed csi-bitrate:%lu < sensor-bitrate:%lu\n",
> > > > + csi_bitrate, sensor_bitrate);
> > > > + return -EINVAL;
> > > > + }
> > > > +
> > > > + /* Best case */
> > > > + if (csi_bitrate == sensor_bitrate) {
> > > > + tc358746->vb_size = TC358746_VB_DEFAULT_SIZE;
> > > > + goto out;
> > > > + }
> > > > +
> > > > + /*
> > > > + * Avoid possible FIFO underflow in case of
> > > > + * csi_bitrate > sensor_bitrate. For such case the chip has a internal
> > > > + * fifo which can be used to delay the line output.
> > > > + *
> > > > + * Fifo size calculation:
> > > > + *
> > > > + * fifo-sz, image-width - in bits
> > > > + * sbr - sensor_bitrate in bits/s
> > > > + * csir - csi_bitrate in bits/s
> > > > + *
> > > > + * 1 1 1
> > > > + * image-width * --- + fifo-sz --- >= ---- * image-width
> > > > + * sbr sbr csir
> > > > + *
> > > > + * fifo-sz >= abs(sbr/csir * image-width - image-width)
> > > > + * `-----´
> > > > + * n
> > > > + *
> > > > + */
> > > > +
> > > > + sensor_bitrate /= TC358746_PRECISION;
> > > > + n = csi_bitrate / sensor_bitrate;
> > > > + tmp = (tc358746->mbusfmt.width * TC358746_PRECISION) / n;
> > > > + fifo_sz = tc358746->mbusfmt.width - tmp;
> > > > + fifo_sz *= fmt->bpp;
> > > > + tc358746->vb_size = round_up(fifo_sz, 32);
> > > > +
> > >
> > > Please also call v4l2_subdev_link_validate_default() here.
> >
> > Did it in my internal prepared v2 ^^ I call it now at the very
> > beginning of this function.
> >
> > > I wonder if the above calculation wouldn't be better performed in
> > > .s_stream() (or rather in a function being called by .s_stream()) when
> > > enabling streaming.
> >
> > No I wouldn't shift that, since the link validation is in IMHO the
> > correct place to inform the user that the pipeline can't negotiate if
> > the fifo can't be configured correctly. Therefore I placed it here.
>
> The issue is that the user could enable the link first, and then change
> the V4L2_CID_LINK_FREQ of the sensor and push the pixel rate above what
> the TC358746 can support. Given the model that configures subdevs
> independently, you can only validate the pipeline at stream on time.
The .link_validate() gets called during the media-pipeline
.link_validate() call which is called by __media_pipeline_start(). The
function description for this function is: "Mark a pipeline as
streaming". So I assume that it is called right in front of the
.s_stream() call and there are no further adaptions on the
V4L2_CID_LINK_FREQ allowed.
> > > > +out:
> > > > + dev_dbg(tc358746->sd.dev,
> > > > + "Found FIFO size[bits]:%u -> aligned to size[bits]:%u\n",
> > > > + fifo_sz, tc358746->vb_size);
> > > > +
> > > > + return tc358746->vb_size > TC358746_VB_MAX_SIZE ? -EINVAL : 0;
> > > > +}
>
> [snip]
>
> > > > +static int tc358746_probe(struct i2c_client *client)
> > > > +{
> > > > + struct clk_init_data mclk_initdata = { };
> > > > + struct device *dev = &client->dev;
> > > > + struct v4l2_fwnode_endpoint *vep;
> > > > + unsigned long csi_link_rate;
> > > > + struct tc358746 *tc358746;
> > > > + struct fwnode_handle *ep;
> > > > + unsigned char csi_lanes;
> > > > + struct v4l2_subdev *sd;
> > > > + struct v4l2_ctrl *ctrl;
> > > > + unsigned long refclk;
> > > > + unsigned int i;
> > > > + int err;
> > > > + u32 val;
> > > > +
> > > > + tc358746 = devm_kzalloc(&client->dev, sizeof(*tc358746), GFP_KERNEL);
> > > > + if (!tc358746)
> > > > + return -ENOMEM;
> > > > +
> > > > + tc358746->regmap = devm_regmap_init_i2c(client, &tc358746_regmap_config);
> > > > + if (IS_ERR(tc358746->regmap))
> > > > + return dev_err_probe(dev, PTR_ERR(tc358746->regmap),
> > > > + "Failed to init regmap\n");
> > > > +
> > > > + tc358746->refclk = devm_clk_get(dev, "refclk");
> > > > + if (IS_ERR(tc358746->refclk))
> > > > + return dev_err_probe(dev, PTR_ERR(tc358746->refclk),
> > > > + "Failed to get refclk\n");
> > > > +
> > > > + err = clk_prepare_enable(tc358746->refclk);
> > > > + if (err)
> > > > + return dev_err_probe(dev, err,
> > > > + "Failed to enable refclk\n");
> > > > +
> > > > + refclk = clk_get_rate(tc358746->refclk);
> > > > + clk_disable_unprepare(tc358746->refclk);
> > > > +
> > > > + if (refclk < 6 * MHZ || refclk > 40 * MHZ)
> > > > + return dev_err_probe(dev, -EINVAL, "Invalid refclk range\n");
> > > > +
> > > > + for (i = 0; i < ARRAY_SIZE(tc358746_supplies); i++)
> > > > + tc358746->supplies[i].supply = tc358746_supplies[i];
> > > > +
> > > > + err = devm_regulator_bulk_get(dev, ARRAY_SIZE(tc358746_supplies),
> > > > + tc358746->supplies);
> > > > + if (err)
> > > > + return dev_err_probe(dev, err, "Failed to get supplies\n");
> > > > +
> > > > + tc358746->reset_gpio = devm_gpiod_get_optional(dev, "reset",
> > > > + GPIOD_OUT_HIGH);
> > > > + if (IS_ERR(tc358746->reset_gpio))
> > > > + return dev_err_probe(dev, PTR_ERR(tc358746->reset_gpio),
> > > > + "Failed to get reset-gpios\n");
> > > > +
> > > > + sd = &tc358746->sd;
> > > > + v4l2_i2c_subdev_init(sd, client, &tc358746_ops);
> > > > + sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
> > > > + sd->entity.function = MEDIA_ENT_F_VID_IF_BRIDGE;
> > > > + sd->entity.ops = &tc358746_entity_ops;
> > > > +
> > > > + tc358746->pads[TC358746_SINK].flags = MEDIA_PAD_FL_SINK;
> > > > + tc358746->pads[TC358746_SOURCE].flags = MEDIA_PAD_FL_SOURCE;
> > > > + err = media_entity_pads_init(&sd->entity, TC358746_NR_PADS,
> > > > + tc358746->pads);
> > > > + if (err)
> > > > + return dev_err_probe(dev, err,
> > > > + "Failed to setup media-entity pads\n");
> > > > +
> > > > + ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(dev), TC358746_SOURCE,
> > > > + 0, 0);
> > > > + if (!ep) {
> > > > + dev_err(dev, "Missing endpoint node\n");
> > > > + err = -EINVAL;
> > > > + goto err_mc;
> > > > + }
> > > > +
> > > > + /* Currently we only support 'parallel in' -> 'csi out' */
> > > > + vep = &tc358746->csi_vep;
> > > > + vep->bus_type = V4L2_MBUS_CSI2_DPHY;
> > > > + err = v4l2_fwnode_endpoint_alloc_parse(ep, vep);
> > > > + fwnode_handle_put(ep);
> > > > + if (err) {
> > > > + dev_err(dev, "Failed to parse source endpoint\n");
> > > > + goto err_mc;
> > > > + }
> > > > +
> > > > + csi_lanes = vep->bus.mipi_csi2.num_data_lanes;
> > > > + if (csi_lanes == 0 || csi_lanes > 4 ||
> > > > + vep->nr_of_link_frequencies == 0) {
> > > > + dev_err(dev, "error: Invalid CSI-2 settings\n");
> > > > + err = -EINVAL;
> > > > + goto err_vep;
> > > > + }
> > > > +
> > > > + /* TODO: Add support to handle multiple link frequencies */
> > > > + csi_link_rate = (unsigned long)vep->link_frequencies[0];
> > > > + tc358746->pll_rate = tc358746_find_pll_settings(tc358746, refclk,
> > > > + csi_link_rate * 2);
> > > > + if (!tc358746->pll_rate) {
> > > > + err = -EINVAL;
> > > > + goto err_vep;
> > > > + }
> > > > +
> > > > + err = phy_mipi_dphy_get_default_config_for_hsclk(tc358746->pll_rate,
> > > > + csi_lanes,
> > > > + &tc358746->dphy_cfg);
> > > > + if (err)
> > > > + goto err_vep;
> > > > +
> > > > + tc358746->mbusfmt = tc358746_def_fmt;
> > > > + tc358746->vb_size = TC358746_VB_DEFAULT_SIZE;
> > > > +
> > > > + dev_set_drvdata(dev, tc358746);
> > > > + pm_runtime_set_autosuspend_delay(dev, 200);
> > > > + pm_runtime_use_autosuspend(dev);
> > > > + pm_runtime_enable(dev);
> > > > +
> > > > + err = pm_runtime_resume_and_get(dev);
> > > > + if (err < 0) {
> > > > + dev_err(dev, "Failed to resume the device\n");
> > > > + goto err_vep;
> > > > + }
> > > > +
> > > > + /* Ensure that CSI interface is put into LP-11 state */
> > > > + err = tc358746_sw_reset(tc358746);
> > > > + if (err) {
> > > > + pm_runtime_put_noidle(dev);
> > > > + dev_err(dev, "Failed to reset the device\n");
> > > > + goto err_pm;
> > > > + }
> > > > +
> > > > + err = tc358746_read(tc358746, CHIPID_REG, &val);
> > > > + pm_runtime_mark_last_busy(dev);
> > > > + pm_runtime_put_sync_autosuspend(dev);
> > > > + if (err) {
> > > > + dev_err(dev, "Failed to read chipid\n");
> > > > + err = -ENODEV;
> > > > + goto err_pm;
> > > > + }
> > > > +
> > > > + if (FIELD_GET(CHIPID, val) != 0x44) {
> > > > + dev_err(dev, "Invalid chipid 0x%02x\n",
> > > > + (u32)FIELD_GET(CHIPID, val));
> > > > + err = -ENODEV;
> > > > + goto err_pm;
> > > > + }
> > > > +
> > > > + /* Optional MCLK provider support */
> > > > + if (device_property_present(dev, "#clock-cells")) {
> > > > + const char *mclk_name;
> > > > +
> > > > + /* Init to highest possibel MCLK */
> > > > + tc358746->mclk_postdiv = 512;
> > > > + tc358746->mclk_prediv = 8;
> > > > +
> > > > + mclk_name = "tc358746-mclk";
> > > > + device_property_read_string(dev, "clock-output-names",
> > > > + &mclk_name);
> > > > +
> > > > + mclk_initdata.name = mclk_name;
> > > > + mclk_initdata.ops = &tc358746_mclk_ops;
> > > > + tc358746->mclk_hw.init = &mclk_initdata;
> > > > +
> > > > + err = devm_clk_hw_register(dev, &tc358746->mclk_hw);
> > > > + if (err) {
> > > > + dev_err(dev, "Failed to register mclk provider\n");
> > > > + goto err_pm;
> > > > + }
> > > > +
> > > > + err = devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get,
> > > > + &tc358746->mclk_hw);
> > > > + if (err) {
> > > > + dev_err(dev, "Failed to add mclk provider\n");
> > > > + goto err_pm;
> > > > + }
> > > > + }
> > > > +
> > > > + v4l2_ctrl_handler_init(&tc358746->ctrl_hdl, 1);
> > > > +
> > > > + ctrl = v4l2_ctrl_new_int_menu(&tc358746->ctrl_hdl, NULL,
> > > > + V4L2_CID_LINK_FREQ, 0, 0,
> > > > + vep->link_frequencies);
> > > > + if (ctrl)
> > > > + ctrl->flags |= V4L2_CTRL_FLAG_READ_ONLY;
> > > > +
> > > > + tc358746->sd.ctrl_handler = &tc358746->ctrl_hdl;
> > > > + if (tc358746->ctrl_hdl.error) {
> > > > + err = tc358746->ctrl_hdl.error;
> > > > + goto err_pm;
> > > > + }
> > > > +
> > > > + v4l2_ctrl_handler_setup(&tc358746->ctrl_hdl);
> > > > +
> > > > + err = tc358746_async_register(tc358746);
> > > > + if (err < 0)
> > > > + goto err_ctrl;
> > > > +
> > > > + dev_info(dev, "%s found @ 0x%x (%s)\n", client->name,
> > > > + client->addr, client->adapter->name);
> > >
> > > I'd skip this to avoid adding noise to the kernel log at boot time. I
> > > would also probably split some of the code out of the probe function as
> > > it's fairly large. Up to you.
> >
> > Yes it is large but most of it is just requesting stuff and so..
> > Therefore I kept it here since I don't need it elsewhere. What about
> > setting it to dev_dbg()? Sometimes it can be useful e.g. to find the
> > problem why /dev/media is not comming up..
>
> I find that enabling dev_dbg() messages from drivers/base/dd.c are
> helpful for that, but a dev_dbg() message here is fine too.
Ah okay, didn't checked that deep. I can remove it if you want, in my v2
I changed it to dev_dbg().
> > > > +
> > > > + return 0;
> > > > +
> > > > +err_ctrl:
> > > > + v4l2_ctrl_handler_free(&tc358746->ctrl_hdl);
> > > > +err_pm:
> > > > + pm_runtime_disable(dev);
> > > > + pm_runtime_set_suspended(dev);
> > > > + pm_runtime_dont_use_autosuspend(dev);
> > > > +err_vep:
> > > > + v4l2_fwnode_endpoint_free(vep);
> > > > +err_mc:
> > > > + media_entity_cleanup(&sd->entity);
> > > > +
> > > > + return err;
> > > > +}
> > > > +
> > > > +static int tc358746_remove(struct i2c_client *client)
> > > > +{
> > > > + struct v4l2_subdev *sd = i2c_get_clientdata(client);
> > > > + struct tc358746 *tc358746 = to_tc358746(sd);
> > > > +
> > > > + v4l2_ctrl_handler_free(&tc358746->ctrl_hdl);
> > > > + v4l2_fwnode_endpoint_free(&tc358746->csi_vep);
> > > > + v4l2_async_nf_unregister(&tc358746->notifier);
> > > > + v4l2_async_nf_cleanup(&tc358746->notifier);
> > > > + v4l2_async_unregister_subdev(sd);
> > > > + v4l2_device_unregister_subdev(sd);
> > >
> > > This shouldn't be needed v4l2_async_unregister_subdev() should be
> > > enough.
> >
> > Okay, thanks. There are a lot of unregister helpers in the v4l2 space..
>
> Too many of them indeed. I'd like to simplify all that.
*Thumbs up*
I already pushed my v2 which needs little rework due to
kernel-test-robot findings so I will send a v3. So if there are any
further findings let's move on to the v2.
Thanks,
Marco
> > > > + media_entity_cleanup(&sd->entity);
> > > > +
> > > > + pm_runtime_disable(sd->dev);
> > > > + pm_runtime_set_suspended(sd->dev);
> > > > + pm_runtime_dont_use_autosuspend(sd->dev);
> > > > +
> > > > + return 0;
> > > > +}
> > > > +
> > > > +static int tc358746_suspend(struct device *dev)
> > > > +{
> > > > + struct tc358746 *tc358746 = dev_get_drvdata(dev);
> > > > +
> > > > + clk_disable_unprepare(tc358746->refclk);
> > > > +
> > > > + return regulator_bulk_disable(ARRAY_SIZE(tc358746_supplies),
> > > > + tc358746->supplies);
> > >
> > > Shouldn't you reenable the clock if this fails ?
> >
> > Hm.. if this fails I could end in a undefined chip state. But I got the
> > point that the framework would be in a bad state if it tries again to
> > suspend the device.
>
> It would be, and without a way to recover, so that could be an issue.
>
> > > > +}
> > > > +
> > > > +static int tc358746_resume(struct device *dev)
> > > > +{
> > > > + struct tc358746 *tc358746 = dev_get_drvdata(dev);
> > > > + int err;
> > > > +
> > > > + gpiod_set_value(tc358746->reset_gpio, 1);
> > > > +
> > > > + err = regulator_bulk_enable(ARRAY_SIZE(tc358746_supplies),
> > > > + tc358746->supplies);
> > > > + if (err)
> > > > + return err;
> > > > +
> > > > + /* min. 200ns */
> > > > + usleep_range(10, 20);
> > > > +
> > > > + gpiod_set_value(tc358746->reset_gpio, 0);
> > > > +
> > > > + err = clk_prepare_enable(tc358746->refclk);
> > > > + if (err)
> > > > + return err;
> > >
> > > The regulators need to be disabled in case of failure here and below
> > > (and so does the clock below).
> >
> > Yes, you're right.
> >
> > > > +
> > > > + /* min. 700us ... 1ms */
> > > > + usleep_range(1000, 1500);
> > > > +
> > > > + /* Sync state */
> > > > + err = tc358746_apply_pll_config(tc358746);
> > > > + if (err)
> > > > + return err;
> > > > +
> > > > + err = tc358746_apply_dphy_config(tc358746);
> > > > + if (err)
> > > > + return err;
> > > > +
> > > > + return tc358746_apply_misc_config(tc358746);
> > >
> > > Does all this belong to the PM resume handler ? It seems configuration
> > > could be handled in .s_stream() instead.
> >
> > This gets called by the s_stream() during getting the power state but I
> > can move the dphy/misc_config to the .s_stream() of course.
>
> That would be nice, thanks.
>
> > The pll
> > needs to be there since the device can be a clock provider e.g. for the
> > sensor.
>
> OK.
>
> > Thanks for the review :)
> >
> > > > +}
> > > > +
> > > > +DEFINE_RUNTIME_DEV_PM_OPS(tc358746_pm_ops, tc358746_suspend,
> > > > + tc358746_resume, NULL);
> > > > +
> > > > +static const struct of_device_id __maybe_unused tc358746_of_match[] = {
> > > > + { .compatible = "toshiba,tc358746" },
> > > > + { },
> > > > +};
> > > > +MODULE_DEVICE_TABLE(of, tc358746_of_match);
> > > > +
> > > > +static struct i2c_driver tc358746_driver = {
> > > > + .driver = {
> > > > + .name = "tc358746",
> > > > + .pm = pm_ptr(&tc358746_pm_ops),
> > > > + .of_match_table = tc358746_of_match,
> > > > + },
> > > > + .probe_new = tc358746_probe,
> > > > + .remove = tc358746_remove,
> > > > +};
> > > > +
> > > > +module_i2c_driver(tc358746_driver);
> > > > +
> > > > +MODULE_DESCRIPTION("Toshiba TC358746 Parallel to CSI-2 bridge driver");
> > > > +MODULE_AUTHOR("Marco Felsch <kernel@pengutronix.de>");
> > > > +MODULE_LICENSE("GPL");
>
> --
> Regards,
>
> Laurent Pinchart
>
^ permalink raw reply [flat|nested] 34+ messages in thread
* Re: [PATCH 4/4] media: tc358746: add Toshiba TC358746 Parallel to CSI-2 bridge driver
@ 2022-09-19 8:40 ` Marco Felsch
0 siblings, 0 replies; 34+ messages in thread
From: Marco Felsch @ 2022-09-19 8:40 UTC (permalink / raw)
To: Laurent Pinchart
Cc: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, linux-kernel, linux-phy,
devicetree, linux-media, kernel
Hi Laurent,
On 22-09-16, Laurent Pinchart wrote:
> Hi Marco,
>
> On Thu, Sep 15, 2022 at 06:54:04PM +0200, Marco Felsch wrote:
> > On 22-09-05, Laurent Pinchart wrote:
> > > On Thu, Aug 18, 2022 at 04:33:07PM +0200, Marco Felsch wrote:
> > > > Adding support for the TC358746 parallel <-> MIPI CSI bridge. This chip
> > > > supports two operating modes:
> > > > 1st) parallel-in -> mipi-csi out
> > > > 2nd) mipi-csi in -> parallel out
> > > >
> > > > This patch only adds the support for the 1st mode.
> > > >
> > > > Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
> > > > ---
> > > > drivers/media/i2c/Kconfig | 17 +
> > > > drivers/media/i2c/Makefile | 1 +
> > > > drivers/media/i2c/tc358746.c | 1645 ++++++++++++++++++++++++++++++++++
> > > > 3 files changed, 1663 insertions(+)
> > > > create mode 100644 drivers/media/i2c/tc358746.c
>
> [snip]
>
> > > > diff --git a/drivers/media/i2c/tc358746.c b/drivers/media/i2c/tc358746.c
> > > > new file mode 100644
> > > > index 000000000000..7b71d0cf72a9
> > > > --- /dev/null
> > > > +++ b/drivers/media/i2c/tc358746.c
>
> [snip]
>
> > > > +struct tc358746 {
> > > > + struct v4l2_subdev sd;
> > > > + struct media_pad pads[TC358746_NR_PADS];
> > > > + struct v4l2_async_notifier notifier;
> > > > + struct v4l2_mbus_framefmt mbusfmt;
> > >
> > > Could you use the active state API instead of manually storing mbusfmt
> > > here ? It involves
> >
> > I will do that, thanks for the hint and it also elimates a few basic
> > checks like the pad-num check.
>
> Even nicer :-)
>
> > > - Implementing the .init_cfg() operation
> > > - Calling v4l2_subdev_init_finalize() in probe
> > > - Replacing calls to __tc358746_get_pad_format() with
> > > v4l2_subdev_get_pad_format()
> > > - Propagating the format from sink to source in tc358746_set_fmt()
> > > - Dropping tc358746_src_mbus_code() from tc358746_get_fmt() and simply
> > > retrieving the format using v4l2_subdev_get_pad_format() there
> > > - Dropping this field
> > >
> > > The formats for both the ACTIVE and TRY states will then be stored in
> > > the subdev state, unconditionally. You can retrieve the active state
> > > with v4l2_subdev_get_locked_active_state() in tc358746_s_stream().
> > >
> > > > + struct v4l2_fwnode_endpoint csi_vep;
> > > > +
> > > > + struct v4l2_ctrl_handler ctrl_hdl;
> > > > +
> > > > + struct regmap *regmap;
> > > > + struct clk *refclk;
> > > > + struct gpio_desc *reset_gpio;
> > > > + struct regulator_bulk_data supplies[ARRAY_SIZE(tc358746_supplies)];
> > > > +
> > > > + struct clk_hw mclk_hw;
> > > > + unsigned long mclk_rate;
> > > > + u8 mclk_prediv;
> > > > + u16 mclk_postdiv;
> > > > +
> > > > + unsigned long pll_rate;
> > > > + u8 pll_post_div;
> > > > + u16 pll_pre_div;
> > > > + u16 pll_mul;
> > > > +
> > > > + struct v4l2_ctrl *sensor_pclk_ctrl;
> > > > +
> > > > +#define TC358746_VB_MAX_SIZE (511 * 32)
> > > > +#define TC358746_VB_DEFAULT_SIZE (1 * 32)
> > > > + unsigned int vb_size; /* Video buffer size in bits */
> > > > +
> > > > + struct phy_configure_opts_mipi_dphy dphy_cfg;
> > > > +};
>
> [snip]
>
> > > > +#ifndef MHZ
> > >
> > > Where would it be previously defined ? This sounds like asking for
> > > trouble later.
> >
> > Sorry I don't get that, do you mean that I should define it at the very
> > beginning?
>
> I mean that either MHZ is defined somewhere in the kernel already, in
> case we should include the corresponding header, or it's not, and I
> wouldn't add an #ifndev here. Otherwise, if someone adds a MHZ macro
> later that gets pulled in through one of the kernel headers used by the
> driver, it may cause subtle bugs if the definition is different. Of
> course nobody will
>
> #define MHZ 42
>
> but we could get
>
> #define MHZ 1000 * 1000
>
> and something could break here. I'd drop the #ifndef to get the compiler
> to complain if there's a redefinition.
Argh.. sorry, now I see what you meant. I have read it like "I'm asking
for troubles" because I'm defining it. Didn't saw that your comment was
only related to the ifndef guard, sure I can drop it.
> > > > +#define MHZ (1000 * 1000)
> > > > +#endif
>
> [snip]
>
> > > > +static int
> > > > +tc358746_link_validate(struct v4l2_subdev *sd, struct media_link *link,
> > > > + struct v4l2_subdev_format *source_fmt,
> > > > + struct v4l2_subdev_format *sink_fmt)
> > > > +{
> > > > + struct tc358746 *tc358746 = to_tc358746(sd);
> > > > + unsigned long csi_bitrate, sensor_bitrate;
> > > > + const struct tc358746_format *fmt;
> > > > + unsigned int fifo_sz, tmp, n;
> > > > + s64 sensor_pclk_rate;
> > > > +
> > > > + /* Check the FIFO settings */
> > > > + fmt = tc358746_get_format_by_code(TC358746_SINK, tc358746->mbusfmt.code);
> > > > + if (IS_ERR(fmt))
> > > > + return PTR_ERR(fmt);
> > > > +
> > > > + sensor_pclk_rate = v4l2_ctrl_g_ctrl_int64(tc358746->sensor_pclk_ctrl);
> > > > + sensor_bitrate = sensor_pclk_rate * fmt->bus_width;
> > > > +
> > > > + csi_bitrate = tc358746->dphy_cfg.lanes * tc358746->pll_rate;
> > > > +
> > > > + dev_dbg(tc358746->sd.dev,
> > > > + "Fifo settings params: sensor-bitrate:%lu csi-bitrate:%lu",
> > > > + sensor_bitrate, csi_bitrate);
> > > > +
> > > > + /* Avoid possible FIFO overflows */
> > > > + if (csi_bitrate < sensor_bitrate) {
> > > > + dev_err(sd->dev,
> > > > + "Link validation failed csi-bitrate:%lu < sensor-bitrate:%lu\n",
> > > > + csi_bitrate, sensor_bitrate);
> > > > + return -EINVAL;
> > > > + }
> > > > +
> > > > + /* Best case */
> > > > + if (csi_bitrate == sensor_bitrate) {
> > > > + tc358746->vb_size = TC358746_VB_DEFAULT_SIZE;
> > > > + goto out;
> > > > + }
> > > > +
> > > > + /*
> > > > + * Avoid possible FIFO underflow in case of
> > > > + * csi_bitrate > sensor_bitrate. For such case the chip has a internal
> > > > + * fifo which can be used to delay the line output.
> > > > + *
> > > > + * Fifo size calculation:
> > > > + *
> > > > + * fifo-sz, image-width - in bits
> > > > + * sbr - sensor_bitrate in bits/s
> > > > + * csir - csi_bitrate in bits/s
> > > > + *
> > > > + * 1 1 1
> > > > + * image-width * --- + fifo-sz --- >= ---- * image-width
> > > > + * sbr sbr csir
> > > > + *
> > > > + * fifo-sz >= abs(sbr/csir * image-width - image-width)
> > > > + * `-----´
> > > > + * n
> > > > + *
> > > > + */
> > > > +
> > > > + sensor_bitrate /= TC358746_PRECISION;
> > > > + n = csi_bitrate / sensor_bitrate;
> > > > + tmp = (tc358746->mbusfmt.width * TC358746_PRECISION) / n;
> > > > + fifo_sz = tc358746->mbusfmt.width - tmp;
> > > > + fifo_sz *= fmt->bpp;
> > > > + tc358746->vb_size = round_up(fifo_sz, 32);
> > > > +
> > >
> > > Please also call v4l2_subdev_link_validate_default() here.
> >
> > Did it in my internal prepared v2 ^^ I call it now at the very
> > beginning of this function.
> >
> > > I wonder if the above calculation wouldn't be better performed in
> > > .s_stream() (or rather in a function being called by .s_stream()) when
> > > enabling streaming.
> >
> > No I wouldn't shift that, since the link validation is in IMHO the
> > correct place to inform the user that the pipeline can't negotiate if
> > the fifo can't be configured correctly. Therefore I placed it here.
>
> The issue is that the user could enable the link first, and then change
> the V4L2_CID_LINK_FREQ of the sensor and push the pixel rate above what
> the TC358746 can support. Given the model that configures subdevs
> independently, you can only validate the pipeline at stream on time.
The .link_validate() gets called during the media-pipeline
.link_validate() call which is called by __media_pipeline_start(). The
function description for this function is: "Mark a pipeline as
streaming". So I assume that it is called right in front of the
.s_stream() call and there are no further adaptions on the
V4L2_CID_LINK_FREQ allowed.
> > > > +out:
> > > > + dev_dbg(tc358746->sd.dev,
> > > > + "Found FIFO size[bits]:%u -> aligned to size[bits]:%u\n",
> > > > + fifo_sz, tc358746->vb_size);
> > > > +
> > > > + return tc358746->vb_size > TC358746_VB_MAX_SIZE ? -EINVAL : 0;
> > > > +}
>
> [snip]
>
> > > > +static int tc358746_probe(struct i2c_client *client)
> > > > +{
> > > > + struct clk_init_data mclk_initdata = { };
> > > > + struct device *dev = &client->dev;
> > > > + struct v4l2_fwnode_endpoint *vep;
> > > > + unsigned long csi_link_rate;
> > > > + struct tc358746 *tc358746;
> > > > + struct fwnode_handle *ep;
> > > > + unsigned char csi_lanes;
> > > > + struct v4l2_subdev *sd;
> > > > + struct v4l2_ctrl *ctrl;
> > > > + unsigned long refclk;
> > > > + unsigned int i;
> > > > + int err;
> > > > + u32 val;
> > > > +
> > > > + tc358746 = devm_kzalloc(&client->dev, sizeof(*tc358746), GFP_KERNEL);
> > > > + if (!tc358746)
> > > > + return -ENOMEM;
> > > > +
> > > > + tc358746->regmap = devm_regmap_init_i2c(client, &tc358746_regmap_config);
> > > > + if (IS_ERR(tc358746->regmap))
> > > > + return dev_err_probe(dev, PTR_ERR(tc358746->regmap),
> > > > + "Failed to init regmap\n");
> > > > +
> > > > + tc358746->refclk = devm_clk_get(dev, "refclk");
> > > > + if (IS_ERR(tc358746->refclk))
> > > > + return dev_err_probe(dev, PTR_ERR(tc358746->refclk),
> > > > + "Failed to get refclk\n");
> > > > +
> > > > + err = clk_prepare_enable(tc358746->refclk);
> > > > + if (err)
> > > > + return dev_err_probe(dev, err,
> > > > + "Failed to enable refclk\n");
> > > > +
> > > > + refclk = clk_get_rate(tc358746->refclk);
> > > > + clk_disable_unprepare(tc358746->refclk);
> > > > +
> > > > + if (refclk < 6 * MHZ || refclk > 40 * MHZ)
> > > > + return dev_err_probe(dev, -EINVAL, "Invalid refclk range\n");
> > > > +
> > > > + for (i = 0; i < ARRAY_SIZE(tc358746_supplies); i++)
> > > > + tc358746->supplies[i].supply = tc358746_supplies[i];
> > > > +
> > > > + err = devm_regulator_bulk_get(dev, ARRAY_SIZE(tc358746_supplies),
> > > > + tc358746->supplies);
> > > > + if (err)
> > > > + return dev_err_probe(dev, err, "Failed to get supplies\n");
> > > > +
> > > > + tc358746->reset_gpio = devm_gpiod_get_optional(dev, "reset",
> > > > + GPIOD_OUT_HIGH);
> > > > + if (IS_ERR(tc358746->reset_gpio))
> > > > + return dev_err_probe(dev, PTR_ERR(tc358746->reset_gpio),
> > > > + "Failed to get reset-gpios\n");
> > > > +
> > > > + sd = &tc358746->sd;
> > > > + v4l2_i2c_subdev_init(sd, client, &tc358746_ops);
> > > > + sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
> > > > + sd->entity.function = MEDIA_ENT_F_VID_IF_BRIDGE;
> > > > + sd->entity.ops = &tc358746_entity_ops;
> > > > +
> > > > + tc358746->pads[TC358746_SINK].flags = MEDIA_PAD_FL_SINK;
> > > > + tc358746->pads[TC358746_SOURCE].flags = MEDIA_PAD_FL_SOURCE;
> > > > + err = media_entity_pads_init(&sd->entity, TC358746_NR_PADS,
> > > > + tc358746->pads);
> > > > + if (err)
> > > > + return dev_err_probe(dev, err,
> > > > + "Failed to setup media-entity pads\n");
> > > > +
> > > > + ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(dev), TC358746_SOURCE,
> > > > + 0, 0);
> > > > + if (!ep) {
> > > > + dev_err(dev, "Missing endpoint node\n");
> > > > + err = -EINVAL;
> > > > + goto err_mc;
> > > > + }
> > > > +
> > > > + /* Currently we only support 'parallel in' -> 'csi out' */
> > > > + vep = &tc358746->csi_vep;
> > > > + vep->bus_type = V4L2_MBUS_CSI2_DPHY;
> > > > + err = v4l2_fwnode_endpoint_alloc_parse(ep, vep);
> > > > + fwnode_handle_put(ep);
> > > > + if (err) {
> > > > + dev_err(dev, "Failed to parse source endpoint\n");
> > > > + goto err_mc;
> > > > + }
> > > > +
> > > > + csi_lanes = vep->bus.mipi_csi2.num_data_lanes;
> > > > + if (csi_lanes == 0 || csi_lanes > 4 ||
> > > > + vep->nr_of_link_frequencies == 0) {
> > > > + dev_err(dev, "error: Invalid CSI-2 settings\n");
> > > > + err = -EINVAL;
> > > > + goto err_vep;
> > > > + }
> > > > +
> > > > + /* TODO: Add support to handle multiple link frequencies */
> > > > + csi_link_rate = (unsigned long)vep->link_frequencies[0];
> > > > + tc358746->pll_rate = tc358746_find_pll_settings(tc358746, refclk,
> > > > + csi_link_rate * 2);
> > > > + if (!tc358746->pll_rate) {
> > > > + err = -EINVAL;
> > > > + goto err_vep;
> > > > + }
> > > > +
> > > > + err = phy_mipi_dphy_get_default_config_for_hsclk(tc358746->pll_rate,
> > > > + csi_lanes,
> > > > + &tc358746->dphy_cfg);
> > > > + if (err)
> > > > + goto err_vep;
> > > > +
> > > > + tc358746->mbusfmt = tc358746_def_fmt;
> > > > + tc358746->vb_size = TC358746_VB_DEFAULT_SIZE;
> > > > +
> > > > + dev_set_drvdata(dev, tc358746);
> > > > + pm_runtime_set_autosuspend_delay(dev, 200);
> > > > + pm_runtime_use_autosuspend(dev);
> > > > + pm_runtime_enable(dev);
> > > > +
> > > > + err = pm_runtime_resume_and_get(dev);
> > > > + if (err < 0) {
> > > > + dev_err(dev, "Failed to resume the device\n");
> > > > + goto err_vep;
> > > > + }
> > > > +
> > > > + /* Ensure that CSI interface is put into LP-11 state */
> > > > + err = tc358746_sw_reset(tc358746);
> > > > + if (err) {
> > > > + pm_runtime_put_noidle(dev);
> > > > + dev_err(dev, "Failed to reset the device\n");
> > > > + goto err_pm;
> > > > + }
> > > > +
> > > > + err = tc358746_read(tc358746, CHIPID_REG, &val);
> > > > + pm_runtime_mark_last_busy(dev);
> > > > + pm_runtime_put_sync_autosuspend(dev);
> > > > + if (err) {
> > > > + dev_err(dev, "Failed to read chipid\n");
> > > > + err = -ENODEV;
> > > > + goto err_pm;
> > > > + }
> > > > +
> > > > + if (FIELD_GET(CHIPID, val) != 0x44) {
> > > > + dev_err(dev, "Invalid chipid 0x%02x\n",
> > > > + (u32)FIELD_GET(CHIPID, val));
> > > > + err = -ENODEV;
> > > > + goto err_pm;
> > > > + }
> > > > +
> > > > + /* Optional MCLK provider support */
> > > > + if (device_property_present(dev, "#clock-cells")) {
> > > > + const char *mclk_name;
> > > > +
> > > > + /* Init to highest possibel MCLK */
> > > > + tc358746->mclk_postdiv = 512;
> > > > + tc358746->mclk_prediv = 8;
> > > > +
> > > > + mclk_name = "tc358746-mclk";
> > > > + device_property_read_string(dev, "clock-output-names",
> > > > + &mclk_name);
> > > > +
> > > > + mclk_initdata.name = mclk_name;
> > > > + mclk_initdata.ops = &tc358746_mclk_ops;
> > > > + tc358746->mclk_hw.init = &mclk_initdata;
> > > > +
> > > > + err = devm_clk_hw_register(dev, &tc358746->mclk_hw);
> > > > + if (err) {
> > > > + dev_err(dev, "Failed to register mclk provider\n");
> > > > + goto err_pm;
> > > > + }
> > > > +
> > > > + err = devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get,
> > > > + &tc358746->mclk_hw);
> > > > + if (err) {
> > > > + dev_err(dev, "Failed to add mclk provider\n");
> > > > + goto err_pm;
> > > > + }
> > > > + }
> > > > +
> > > > + v4l2_ctrl_handler_init(&tc358746->ctrl_hdl, 1);
> > > > +
> > > > + ctrl = v4l2_ctrl_new_int_menu(&tc358746->ctrl_hdl, NULL,
> > > > + V4L2_CID_LINK_FREQ, 0, 0,
> > > > + vep->link_frequencies);
> > > > + if (ctrl)
> > > > + ctrl->flags |= V4L2_CTRL_FLAG_READ_ONLY;
> > > > +
> > > > + tc358746->sd.ctrl_handler = &tc358746->ctrl_hdl;
> > > > + if (tc358746->ctrl_hdl.error) {
> > > > + err = tc358746->ctrl_hdl.error;
> > > > + goto err_pm;
> > > > + }
> > > > +
> > > > + v4l2_ctrl_handler_setup(&tc358746->ctrl_hdl);
> > > > +
> > > > + err = tc358746_async_register(tc358746);
> > > > + if (err < 0)
> > > > + goto err_ctrl;
> > > > +
> > > > + dev_info(dev, "%s found @ 0x%x (%s)\n", client->name,
> > > > + client->addr, client->adapter->name);
> > >
> > > I'd skip this to avoid adding noise to the kernel log at boot time. I
> > > would also probably split some of the code out of the probe function as
> > > it's fairly large. Up to you.
> >
> > Yes it is large but most of it is just requesting stuff and so..
> > Therefore I kept it here since I don't need it elsewhere. What about
> > setting it to dev_dbg()? Sometimes it can be useful e.g. to find the
> > problem why /dev/media is not comming up..
>
> I find that enabling dev_dbg() messages from drivers/base/dd.c are
> helpful for that, but a dev_dbg() message here is fine too.
Ah okay, didn't checked that deep. I can remove it if you want, in my v2
I changed it to dev_dbg().
> > > > +
> > > > + return 0;
> > > > +
> > > > +err_ctrl:
> > > > + v4l2_ctrl_handler_free(&tc358746->ctrl_hdl);
> > > > +err_pm:
> > > > + pm_runtime_disable(dev);
> > > > + pm_runtime_set_suspended(dev);
> > > > + pm_runtime_dont_use_autosuspend(dev);
> > > > +err_vep:
> > > > + v4l2_fwnode_endpoint_free(vep);
> > > > +err_mc:
> > > > + media_entity_cleanup(&sd->entity);
> > > > +
> > > > + return err;
> > > > +}
> > > > +
> > > > +static int tc358746_remove(struct i2c_client *client)
> > > > +{
> > > > + struct v4l2_subdev *sd = i2c_get_clientdata(client);
> > > > + struct tc358746 *tc358746 = to_tc358746(sd);
> > > > +
> > > > + v4l2_ctrl_handler_free(&tc358746->ctrl_hdl);
> > > > + v4l2_fwnode_endpoint_free(&tc358746->csi_vep);
> > > > + v4l2_async_nf_unregister(&tc358746->notifier);
> > > > + v4l2_async_nf_cleanup(&tc358746->notifier);
> > > > + v4l2_async_unregister_subdev(sd);
> > > > + v4l2_device_unregister_subdev(sd);
> > >
> > > This shouldn't be needed v4l2_async_unregister_subdev() should be
> > > enough.
> >
> > Okay, thanks. There are a lot of unregister helpers in the v4l2 space..
>
> Too many of them indeed. I'd like to simplify all that.
*Thumbs up*
I already pushed my v2 which needs little rework due to
kernel-test-robot findings so I will send a v3. So if there are any
further findings let's move on to the v2.
Thanks,
Marco
> > > > + media_entity_cleanup(&sd->entity);
> > > > +
> > > > + pm_runtime_disable(sd->dev);
> > > > + pm_runtime_set_suspended(sd->dev);
> > > > + pm_runtime_dont_use_autosuspend(sd->dev);
> > > > +
> > > > + return 0;
> > > > +}
> > > > +
> > > > +static int tc358746_suspend(struct device *dev)
> > > > +{
> > > > + struct tc358746 *tc358746 = dev_get_drvdata(dev);
> > > > +
> > > > + clk_disable_unprepare(tc358746->refclk);
> > > > +
> > > > + return regulator_bulk_disable(ARRAY_SIZE(tc358746_supplies),
> > > > + tc358746->supplies);
> > >
> > > Shouldn't you reenable the clock if this fails ?
> >
> > Hm.. if this fails I could end in a undefined chip state. But I got the
> > point that the framework would be in a bad state if it tries again to
> > suspend the device.
>
> It would be, and without a way to recover, so that could be an issue.
>
> > > > +}
> > > > +
> > > > +static int tc358746_resume(struct device *dev)
> > > > +{
> > > > + struct tc358746 *tc358746 = dev_get_drvdata(dev);
> > > > + int err;
> > > > +
> > > > + gpiod_set_value(tc358746->reset_gpio, 1);
> > > > +
> > > > + err = regulator_bulk_enable(ARRAY_SIZE(tc358746_supplies),
> > > > + tc358746->supplies);
> > > > + if (err)
> > > > + return err;
> > > > +
> > > > + /* min. 200ns */
> > > > + usleep_range(10, 20);
> > > > +
> > > > + gpiod_set_value(tc358746->reset_gpio, 0);
> > > > +
> > > > + err = clk_prepare_enable(tc358746->refclk);
> > > > + if (err)
> > > > + return err;
> > >
> > > The regulators need to be disabled in case of failure here and below
> > > (and so does the clock below).
> >
> > Yes, you're right.
> >
> > > > +
> > > > + /* min. 700us ... 1ms */
> > > > + usleep_range(1000, 1500);
> > > > +
> > > > + /* Sync state */
> > > > + err = tc358746_apply_pll_config(tc358746);
> > > > + if (err)
> > > > + return err;
> > > > +
> > > > + err = tc358746_apply_dphy_config(tc358746);
> > > > + if (err)
> > > > + return err;
> > > > +
> > > > + return tc358746_apply_misc_config(tc358746);
> > >
> > > Does all this belong to the PM resume handler ? It seems configuration
> > > could be handled in .s_stream() instead.
> >
> > This gets called by the s_stream() during getting the power state but I
> > can move the dphy/misc_config to the .s_stream() of course.
>
> That would be nice, thanks.
>
> > The pll
> > needs to be there since the device can be a clock provider e.g. for the
> > sensor.
>
> OK.
>
> > Thanks for the review :)
> >
> > > > +}
> > > > +
> > > > +DEFINE_RUNTIME_DEV_PM_OPS(tc358746_pm_ops, tc358746_suspend,
> > > > + tc358746_resume, NULL);
> > > > +
> > > > +static const struct of_device_id __maybe_unused tc358746_of_match[] = {
> > > > + { .compatible = "toshiba,tc358746" },
> > > > + { },
> > > > +};
> > > > +MODULE_DEVICE_TABLE(of, tc358746_of_match);
> > > > +
> > > > +static struct i2c_driver tc358746_driver = {
> > > > + .driver = {
> > > > + .name = "tc358746",
> > > > + .pm = pm_ptr(&tc358746_pm_ops),
> > > > + .of_match_table = tc358746_of_match,
> > > > + },
> > > > + .probe_new = tc358746_probe,
> > > > + .remove = tc358746_remove,
> > > > +};
> > > > +
> > > > +module_i2c_driver(tc358746_driver);
> > > > +
> > > > +MODULE_DESCRIPTION("Toshiba TC358746 Parallel to CSI-2 bridge driver");
> > > > +MODULE_AUTHOR("Marco Felsch <kernel@pengutronix.de>");
> > > > +MODULE_LICENSE("GPL");
>
> --
> Regards,
>
> Laurent Pinchart
>
--
linux-phy mailing list
linux-phy@lists.infradead.org
https://lists.infradead.org/mailman/listinfo/linux-phy
^ permalink raw reply [flat|nested] 34+ messages in thread
* Re: [PATCH 4/4] media: tc358746: add Toshiba TC358746 Parallel to CSI-2 bridge driver
2022-09-19 8:40 ` Marco Felsch
@ 2022-09-19 10:57 ` Laurent Pinchart
-1 siblings, 0 replies; 34+ messages in thread
From: Laurent Pinchart @ 2022-09-19 10:57 UTC (permalink / raw)
To: Marco Felsch
Cc: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, linux-kernel, linux-phy,
devicetree, linux-media, kernel
Hi Marco,
On Mon, Sep 19, 2022 at 10:40:38AM +0200, Marco Felsch wrote:
> On 22-09-16, Laurent Pinchart wrote:
> > On Thu, Sep 15, 2022 at 06:54:04PM +0200, Marco Felsch wrote:
> > > On 22-09-05, Laurent Pinchart wrote:
> > > > On Thu, Aug 18, 2022 at 04:33:07PM +0200, Marco Felsch wrote:
> > > > > Adding support for the TC358746 parallel <-> MIPI CSI bridge. This chip
> > > > > supports two operating modes:
> > > > > 1st) parallel-in -> mipi-csi out
> > > > > 2nd) mipi-csi in -> parallel out
> > > > >
> > > > > This patch only adds the support for the 1st mode.
> > > > >
> > > > > Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
> > > > > ---
> > > > > drivers/media/i2c/Kconfig | 17 +
> > > > > drivers/media/i2c/Makefile | 1 +
> > > > > drivers/media/i2c/tc358746.c | 1645 ++++++++++++++++++++++++++++++++++
> > > > > 3 files changed, 1663 insertions(+)
> > > > > create mode 100644 drivers/media/i2c/tc358746.c
> >
> > [snip]
> >
> > > > > diff --git a/drivers/media/i2c/tc358746.c b/drivers/media/i2c/tc358746.c
> > > > > new file mode 100644
> > > > > index 000000000000..7b71d0cf72a9
> > > > > --- /dev/null
> > > > > +++ b/drivers/media/i2c/tc358746.c
> >
> > [snip]
> >
> > > > > +struct tc358746 {
> > > > > + struct v4l2_subdev sd;
> > > > > + struct media_pad pads[TC358746_NR_PADS];
> > > > > + struct v4l2_async_notifier notifier;
> > > > > + struct v4l2_mbus_framefmt mbusfmt;
> > > >
> > > > Could you use the active state API instead of manually storing mbusfmt
> > > > here ? It involves
> > >
> > > I will do that, thanks for the hint and it also elimates a few basic
> > > checks like the pad-num check.
> >
> > Even nicer :-)
> >
> > > > - Implementing the .init_cfg() operation
> > > > - Calling v4l2_subdev_init_finalize() in probe
> > > > - Replacing calls to __tc358746_get_pad_format() with
> > > > v4l2_subdev_get_pad_format()
> > > > - Propagating the format from sink to source in tc358746_set_fmt()
> > > > - Dropping tc358746_src_mbus_code() from tc358746_get_fmt() and simply
> > > > retrieving the format using v4l2_subdev_get_pad_format() there
> > > > - Dropping this field
> > > >
> > > > The formats for both the ACTIVE and TRY states will then be stored in
> > > > the subdev state, unconditionally. You can retrieve the active state
> > > > with v4l2_subdev_get_locked_active_state() in tc358746_s_stream().
> > > >
> > > > > + struct v4l2_fwnode_endpoint csi_vep;
> > > > > +
> > > > > + struct v4l2_ctrl_handler ctrl_hdl;
> > > > > +
> > > > > + struct regmap *regmap;
> > > > > + struct clk *refclk;
> > > > > + struct gpio_desc *reset_gpio;
> > > > > + struct regulator_bulk_data supplies[ARRAY_SIZE(tc358746_supplies)];
> > > > > +
> > > > > + struct clk_hw mclk_hw;
> > > > > + unsigned long mclk_rate;
> > > > > + u8 mclk_prediv;
> > > > > + u16 mclk_postdiv;
> > > > > +
> > > > > + unsigned long pll_rate;
> > > > > + u8 pll_post_div;
> > > > > + u16 pll_pre_div;
> > > > > + u16 pll_mul;
> > > > > +
> > > > > + struct v4l2_ctrl *sensor_pclk_ctrl;
> > > > > +
> > > > > +#define TC358746_VB_MAX_SIZE (511 * 32)
> > > > > +#define TC358746_VB_DEFAULT_SIZE (1 * 32)
> > > > > + unsigned int vb_size; /* Video buffer size in bits */
> > > > > +
> > > > > + struct phy_configure_opts_mipi_dphy dphy_cfg;
> > > > > +};
> >
> > [snip]
> >
> > > > > +#ifndef MHZ
> > > >
> > > > Where would it be previously defined ? This sounds like asking for
> > > > trouble later.
> > >
> > > Sorry I don't get that, do you mean that I should define it at the very
> > > beginning?
> >
> > I mean that either MHZ is defined somewhere in the kernel already, in
> > case we should include the corresponding header, or it's not, and I
> > wouldn't add an #ifndev here. Otherwise, if someone adds a MHZ macro
> > later that gets pulled in through one of the kernel headers used by the
> > driver, it may cause subtle bugs if the definition is different. Of
> > course nobody will
> >
> > #define MHZ 42
> >
> > but we could get
> >
> > #define MHZ 1000 * 1000
> >
> > and something could break here. I'd drop the #ifndef to get the compiler
> > to complain if there's a redefinition.
>
> Argh.. sorry, now I see what you meant. I have read it like "I'm asking
> for troubles" because I'm defining it. Didn't saw that your comment was
> only related to the ifndef guard, sure I can drop it.
>
> > > > > +#define MHZ (1000 * 1000)
> > > > > +#endif
> >
> > [snip]
> >
> > > > > +static int
> > > > > +tc358746_link_validate(struct v4l2_subdev *sd, struct media_link *link,
> > > > > + struct v4l2_subdev_format *source_fmt,
> > > > > + struct v4l2_subdev_format *sink_fmt)
> > > > > +{
> > > > > + struct tc358746 *tc358746 = to_tc358746(sd);
> > > > > + unsigned long csi_bitrate, sensor_bitrate;
> > > > > + const struct tc358746_format *fmt;
> > > > > + unsigned int fifo_sz, tmp, n;
> > > > > + s64 sensor_pclk_rate;
> > > > > +
> > > > > + /* Check the FIFO settings */
> > > > > + fmt = tc358746_get_format_by_code(TC358746_SINK, tc358746->mbusfmt.code);
> > > > > + if (IS_ERR(fmt))
> > > > > + return PTR_ERR(fmt);
> > > > > +
> > > > > + sensor_pclk_rate = v4l2_ctrl_g_ctrl_int64(tc358746->sensor_pclk_ctrl);
> > > > > + sensor_bitrate = sensor_pclk_rate * fmt->bus_width;
> > > > > +
> > > > > + csi_bitrate = tc358746->dphy_cfg.lanes * tc358746->pll_rate;
> > > > > +
> > > > > + dev_dbg(tc358746->sd.dev,
> > > > > + "Fifo settings params: sensor-bitrate:%lu csi-bitrate:%lu",
> > > > > + sensor_bitrate, csi_bitrate);
> > > > > +
> > > > > + /* Avoid possible FIFO overflows */
> > > > > + if (csi_bitrate < sensor_bitrate) {
> > > > > + dev_err(sd->dev,
> > > > > + "Link validation failed csi-bitrate:%lu < sensor-bitrate:%lu\n",
> > > > > + csi_bitrate, sensor_bitrate);
> > > > > + return -EINVAL;
> > > > > + }
> > > > > +
> > > > > + /* Best case */
> > > > > + if (csi_bitrate == sensor_bitrate) {
> > > > > + tc358746->vb_size = TC358746_VB_DEFAULT_SIZE;
> > > > > + goto out;
> > > > > + }
> > > > > +
> > > > > + /*
> > > > > + * Avoid possible FIFO underflow in case of
> > > > > + * csi_bitrate > sensor_bitrate. For such case the chip has a internal
> > > > > + * fifo which can be used to delay the line output.
> > > > > + *
> > > > > + * Fifo size calculation:
> > > > > + *
> > > > > + * fifo-sz, image-width - in bits
> > > > > + * sbr - sensor_bitrate in bits/s
> > > > > + * csir - csi_bitrate in bits/s
> > > > > + *
> > > > > + * 1 1 1
> > > > > + * image-width * --- + fifo-sz --- >= ---- * image-width
> > > > > + * sbr sbr csir
> > > > > + *
> > > > > + * fifo-sz >= abs(sbr/csir * image-width - image-width)
> > > > > + * `-----´
> > > > > + * n
> > > > > + *
> > > > > + */
> > > > > +
> > > > > + sensor_bitrate /= TC358746_PRECISION;
> > > > > + n = csi_bitrate / sensor_bitrate;
> > > > > + tmp = (tc358746->mbusfmt.width * TC358746_PRECISION) / n;
> > > > > + fifo_sz = tc358746->mbusfmt.width - tmp;
> > > > > + fifo_sz *= fmt->bpp;
> > > > > + tc358746->vb_size = round_up(fifo_sz, 32);
> > > > > +
> > > >
> > > > Please also call v4l2_subdev_link_validate_default() here.
> > >
> > > Did it in my internal prepared v2 ^^ I call it now at the very
> > > beginning of this function.
> > >
> > > > I wonder if the above calculation wouldn't be better performed in
> > > > .s_stream() (or rather in a function being called by .s_stream()) when
> > > > enabling streaming.
> > >
> > > No I wouldn't shift that, since the link validation is in IMHO the
> > > correct place to inform the user that the pipeline can't negotiate if
> > > the fifo can't be configured correctly. Therefore I placed it here.
> >
> > The issue is that the user could enable the link first, and then change
> > the V4L2_CID_LINK_FREQ of the sensor and push the pixel rate above what
> > the TC358746 can support. Given the model that configures subdevs
> > independently, you can only validate the pipeline at stream on time.
>
> The .link_validate() gets called during the media-pipeline
> .link_validate() call which is called by __media_pipeline_start(). The
> function description for this function is: "Mark a pipeline as
> streaming". So I assume that it is called right in front of the
> .s_stream() call and there are no further adaptions on the
> V4L2_CID_LINK_FREQ allowed.
You're right, I mistook link validation for link setup. It should be
fine then, although the subdev core currently doesn't correctly enforce
that the link frequency won't change. This needs to be addressed in the
core (and will likely then require changes in drivers), but that's not
an issue for this patch.
> > > > > +out:
> > > > > + dev_dbg(tc358746->sd.dev,
> > > > > + "Found FIFO size[bits]:%u -> aligned to size[bits]:%u\n",
> > > > > + fifo_sz, tc358746->vb_size);
> > > > > +
> > > > > + return tc358746->vb_size > TC358746_VB_MAX_SIZE ? -EINVAL : 0;
> > > > > +}
> >
> > [snip]
> >
> > > > > +static int tc358746_probe(struct i2c_client *client)
> > > > > +{
> > > > > + struct clk_init_data mclk_initdata = { };
> > > > > + struct device *dev = &client->dev;
> > > > > + struct v4l2_fwnode_endpoint *vep;
> > > > > + unsigned long csi_link_rate;
> > > > > + struct tc358746 *tc358746;
> > > > > + struct fwnode_handle *ep;
> > > > > + unsigned char csi_lanes;
> > > > > + struct v4l2_subdev *sd;
> > > > > + struct v4l2_ctrl *ctrl;
> > > > > + unsigned long refclk;
> > > > > + unsigned int i;
> > > > > + int err;
> > > > > + u32 val;
> > > > > +
> > > > > + tc358746 = devm_kzalloc(&client->dev, sizeof(*tc358746), GFP_KERNEL);
> > > > > + if (!tc358746)
> > > > > + return -ENOMEM;
> > > > > +
> > > > > + tc358746->regmap = devm_regmap_init_i2c(client, &tc358746_regmap_config);
> > > > > + if (IS_ERR(tc358746->regmap))
> > > > > + return dev_err_probe(dev, PTR_ERR(tc358746->regmap),
> > > > > + "Failed to init regmap\n");
> > > > > +
> > > > > + tc358746->refclk = devm_clk_get(dev, "refclk");
> > > > > + if (IS_ERR(tc358746->refclk))
> > > > > + return dev_err_probe(dev, PTR_ERR(tc358746->refclk),
> > > > > + "Failed to get refclk\n");
> > > > > +
> > > > > + err = clk_prepare_enable(tc358746->refclk);
> > > > > + if (err)
> > > > > + return dev_err_probe(dev, err,
> > > > > + "Failed to enable refclk\n");
> > > > > +
> > > > > + refclk = clk_get_rate(tc358746->refclk);
> > > > > + clk_disable_unprepare(tc358746->refclk);
> > > > > +
> > > > > + if (refclk < 6 * MHZ || refclk > 40 * MHZ)
> > > > > + return dev_err_probe(dev, -EINVAL, "Invalid refclk range\n");
> > > > > +
> > > > > + for (i = 0; i < ARRAY_SIZE(tc358746_supplies); i++)
> > > > > + tc358746->supplies[i].supply = tc358746_supplies[i];
> > > > > +
> > > > > + err = devm_regulator_bulk_get(dev, ARRAY_SIZE(tc358746_supplies),
> > > > > + tc358746->supplies);
> > > > > + if (err)
> > > > > + return dev_err_probe(dev, err, "Failed to get supplies\n");
> > > > > +
> > > > > + tc358746->reset_gpio = devm_gpiod_get_optional(dev, "reset",
> > > > > + GPIOD_OUT_HIGH);
> > > > > + if (IS_ERR(tc358746->reset_gpio))
> > > > > + return dev_err_probe(dev, PTR_ERR(tc358746->reset_gpio),
> > > > > + "Failed to get reset-gpios\n");
> > > > > +
> > > > > + sd = &tc358746->sd;
> > > > > + v4l2_i2c_subdev_init(sd, client, &tc358746_ops);
> > > > > + sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
> > > > > + sd->entity.function = MEDIA_ENT_F_VID_IF_BRIDGE;
> > > > > + sd->entity.ops = &tc358746_entity_ops;
> > > > > +
> > > > > + tc358746->pads[TC358746_SINK].flags = MEDIA_PAD_FL_SINK;
> > > > > + tc358746->pads[TC358746_SOURCE].flags = MEDIA_PAD_FL_SOURCE;
> > > > > + err = media_entity_pads_init(&sd->entity, TC358746_NR_PADS,
> > > > > + tc358746->pads);
> > > > > + if (err)
> > > > > + return dev_err_probe(dev, err,
> > > > > + "Failed to setup media-entity pads\n");
> > > > > +
> > > > > + ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(dev), TC358746_SOURCE,
> > > > > + 0, 0);
> > > > > + if (!ep) {
> > > > > + dev_err(dev, "Missing endpoint node\n");
> > > > > + err = -EINVAL;
> > > > > + goto err_mc;
> > > > > + }
> > > > > +
> > > > > + /* Currently we only support 'parallel in' -> 'csi out' */
> > > > > + vep = &tc358746->csi_vep;
> > > > > + vep->bus_type = V4L2_MBUS_CSI2_DPHY;
> > > > > + err = v4l2_fwnode_endpoint_alloc_parse(ep, vep);
> > > > > + fwnode_handle_put(ep);
> > > > > + if (err) {
> > > > > + dev_err(dev, "Failed to parse source endpoint\n");
> > > > > + goto err_mc;
> > > > > + }
> > > > > +
> > > > > + csi_lanes = vep->bus.mipi_csi2.num_data_lanes;
> > > > > + if (csi_lanes == 0 || csi_lanes > 4 ||
> > > > > + vep->nr_of_link_frequencies == 0) {
> > > > > + dev_err(dev, "error: Invalid CSI-2 settings\n");
> > > > > + err = -EINVAL;
> > > > > + goto err_vep;
> > > > > + }
> > > > > +
> > > > > + /* TODO: Add support to handle multiple link frequencies */
> > > > > + csi_link_rate = (unsigned long)vep->link_frequencies[0];
> > > > > + tc358746->pll_rate = tc358746_find_pll_settings(tc358746, refclk,
> > > > > + csi_link_rate * 2);
> > > > > + if (!tc358746->pll_rate) {
> > > > > + err = -EINVAL;
> > > > > + goto err_vep;
> > > > > + }
> > > > > +
> > > > > + err = phy_mipi_dphy_get_default_config_for_hsclk(tc358746->pll_rate,
> > > > > + csi_lanes,
> > > > > + &tc358746->dphy_cfg);
> > > > > + if (err)
> > > > > + goto err_vep;
> > > > > +
> > > > > + tc358746->mbusfmt = tc358746_def_fmt;
> > > > > + tc358746->vb_size = TC358746_VB_DEFAULT_SIZE;
> > > > > +
> > > > > + dev_set_drvdata(dev, tc358746);
> > > > > + pm_runtime_set_autosuspend_delay(dev, 200);
> > > > > + pm_runtime_use_autosuspend(dev);
> > > > > + pm_runtime_enable(dev);
> > > > > +
> > > > > + err = pm_runtime_resume_and_get(dev);
> > > > > + if (err < 0) {
> > > > > + dev_err(dev, "Failed to resume the device\n");
> > > > > + goto err_vep;
> > > > > + }
> > > > > +
> > > > > + /* Ensure that CSI interface is put into LP-11 state */
> > > > > + err = tc358746_sw_reset(tc358746);
> > > > > + if (err) {
> > > > > + pm_runtime_put_noidle(dev);
> > > > > + dev_err(dev, "Failed to reset the device\n");
> > > > > + goto err_pm;
> > > > > + }
> > > > > +
> > > > > + err = tc358746_read(tc358746, CHIPID_REG, &val);
> > > > > + pm_runtime_mark_last_busy(dev);
> > > > > + pm_runtime_put_sync_autosuspend(dev);
> > > > > + if (err) {
> > > > > + dev_err(dev, "Failed to read chipid\n");
> > > > > + err = -ENODEV;
> > > > > + goto err_pm;
> > > > > + }
> > > > > +
> > > > > + if (FIELD_GET(CHIPID, val) != 0x44) {
> > > > > + dev_err(dev, "Invalid chipid 0x%02x\n",
> > > > > + (u32)FIELD_GET(CHIPID, val));
> > > > > + err = -ENODEV;
> > > > > + goto err_pm;
> > > > > + }
> > > > > +
> > > > > + /* Optional MCLK provider support */
> > > > > + if (device_property_present(dev, "#clock-cells")) {
> > > > > + const char *mclk_name;
> > > > > +
> > > > > + /* Init to highest possibel MCLK */
> > > > > + tc358746->mclk_postdiv = 512;
> > > > > + tc358746->mclk_prediv = 8;
> > > > > +
> > > > > + mclk_name = "tc358746-mclk";
> > > > > + device_property_read_string(dev, "clock-output-names",
> > > > > + &mclk_name);
> > > > > +
> > > > > + mclk_initdata.name = mclk_name;
> > > > > + mclk_initdata.ops = &tc358746_mclk_ops;
> > > > > + tc358746->mclk_hw.init = &mclk_initdata;
> > > > > +
> > > > > + err = devm_clk_hw_register(dev, &tc358746->mclk_hw);
> > > > > + if (err) {
> > > > > + dev_err(dev, "Failed to register mclk provider\n");
> > > > > + goto err_pm;
> > > > > + }
> > > > > +
> > > > > + err = devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get,
> > > > > + &tc358746->mclk_hw);
> > > > > + if (err) {
> > > > > + dev_err(dev, "Failed to add mclk provider\n");
> > > > > + goto err_pm;
> > > > > + }
> > > > > + }
> > > > > +
> > > > > + v4l2_ctrl_handler_init(&tc358746->ctrl_hdl, 1);
> > > > > +
> > > > > + ctrl = v4l2_ctrl_new_int_menu(&tc358746->ctrl_hdl, NULL,
> > > > > + V4L2_CID_LINK_FREQ, 0, 0,
> > > > > + vep->link_frequencies);
> > > > > + if (ctrl)
> > > > > + ctrl->flags |= V4L2_CTRL_FLAG_READ_ONLY;
> > > > > +
> > > > > + tc358746->sd.ctrl_handler = &tc358746->ctrl_hdl;
> > > > > + if (tc358746->ctrl_hdl.error) {
> > > > > + err = tc358746->ctrl_hdl.error;
> > > > > + goto err_pm;
> > > > > + }
> > > > > +
> > > > > + v4l2_ctrl_handler_setup(&tc358746->ctrl_hdl);
> > > > > +
> > > > > + err = tc358746_async_register(tc358746);
> > > > > + if (err < 0)
> > > > > + goto err_ctrl;
> > > > > +
> > > > > + dev_info(dev, "%s found @ 0x%x (%s)\n", client->name,
> > > > > + client->addr, client->adapter->name);
> > > >
> > > > I'd skip this to avoid adding noise to the kernel log at boot time. I
> > > > would also probably split some of the code out of the probe function as
> > > > it's fairly large. Up to you.
> > >
> > > Yes it is large but most of it is just requesting stuff and so..
> > > Therefore I kept it here since I don't need it elsewhere. What about
> > > setting it to dev_dbg()? Sometimes it can be useful e.g. to find the
> > > problem why /dev/media is not comming up..
> >
> > I find that enabling dev_dbg() messages from drivers/base/dd.c are
> > helpful for that, but a dev_dbg() message here is fine too.
>
> Ah okay, didn't checked that deep. I can remove it if you want, in my v2
> I changed it to dev_dbg().
>
> > > > > +
> > > > > + return 0;
> > > > > +
> > > > > +err_ctrl:
> > > > > + v4l2_ctrl_handler_free(&tc358746->ctrl_hdl);
> > > > > +err_pm:
> > > > > + pm_runtime_disable(dev);
> > > > > + pm_runtime_set_suspended(dev);
> > > > > + pm_runtime_dont_use_autosuspend(dev);
> > > > > +err_vep:
> > > > > + v4l2_fwnode_endpoint_free(vep);
> > > > > +err_mc:
> > > > > + media_entity_cleanup(&sd->entity);
> > > > > +
> > > > > + return err;
> > > > > +}
> > > > > +
> > > > > +static int tc358746_remove(struct i2c_client *client)
> > > > > +{
> > > > > + struct v4l2_subdev *sd = i2c_get_clientdata(client);
> > > > > + struct tc358746 *tc358746 = to_tc358746(sd);
> > > > > +
> > > > > + v4l2_ctrl_handler_free(&tc358746->ctrl_hdl);
> > > > > + v4l2_fwnode_endpoint_free(&tc358746->csi_vep);
> > > > > + v4l2_async_nf_unregister(&tc358746->notifier);
> > > > > + v4l2_async_nf_cleanup(&tc358746->notifier);
> > > > > + v4l2_async_unregister_subdev(sd);
> > > > > + v4l2_device_unregister_subdev(sd);
> > > >
> > > > This shouldn't be needed v4l2_async_unregister_subdev() should be
> > > > enough.
> > >
> > > Okay, thanks. There are a lot of unregister helpers in the v4l2 space..
> >
> > Too many of them indeed. I'd like to simplify all that.
>
> *Thumbs up*
>
> I already pushed my v2 which needs little rework due to
> kernel-test-robot findings so I will send a v3. So if there are any
> further findings let's move on to the v2.
>
> > > > > + media_entity_cleanup(&sd->entity);
> > > > > +
> > > > > + pm_runtime_disable(sd->dev);
> > > > > + pm_runtime_set_suspended(sd->dev);
> > > > > + pm_runtime_dont_use_autosuspend(sd->dev);
> > > > > +
> > > > > + return 0;
> > > > > +}
> > > > > +
> > > > > +static int tc358746_suspend(struct device *dev)
> > > > > +{
> > > > > + struct tc358746 *tc358746 = dev_get_drvdata(dev);
> > > > > +
> > > > > + clk_disable_unprepare(tc358746->refclk);
> > > > > +
> > > > > + return regulator_bulk_disable(ARRAY_SIZE(tc358746_supplies),
> > > > > + tc358746->supplies);
> > > >
> > > > Shouldn't you reenable the clock if this fails ?
> > >
> > > Hm.. if this fails I could end in a undefined chip state. But I got the
> > > point that the framework would be in a bad state if it tries again to
> > > suspend the device.
> >
> > It would be, and without a way to recover, so that could be an issue.
> >
> > > > > +}
> > > > > +
> > > > > +static int tc358746_resume(struct device *dev)
> > > > > +{
> > > > > + struct tc358746 *tc358746 = dev_get_drvdata(dev);
> > > > > + int err;
> > > > > +
> > > > > + gpiod_set_value(tc358746->reset_gpio, 1);
> > > > > +
> > > > > + err = regulator_bulk_enable(ARRAY_SIZE(tc358746_supplies),
> > > > > + tc358746->supplies);
> > > > > + if (err)
> > > > > + return err;
> > > > > +
> > > > > + /* min. 200ns */
> > > > > + usleep_range(10, 20);
> > > > > +
> > > > > + gpiod_set_value(tc358746->reset_gpio, 0);
> > > > > +
> > > > > + err = clk_prepare_enable(tc358746->refclk);
> > > > > + if (err)
> > > > > + return err;
> > > >
> > > > The regulators need to be disabled in case of failure here and below
> > > > (and so does the clock below).
> > >
> > > Yes, you're right.
> > >
> > > > > +
> > > > > + /* min. 700us ... 1ms */
> > > > > + usleep_range(1000, 1500);
> > > > > +
> > > > > + /* Sync state */
> > > > > + err = tc358746_apply_pll_config(tc358746);
> > > > > + if (err)
> > > > > + return err;
> > > > > +
> > > > > + err = tc358746_apply_dphy_config(tc358746);
> > > > > + if (err)
> > > > > + return err;
> > > > > +
> > > > > + return tc358746_apply_misc_config(tc358746);
> > > >
> > > > Does all this belong to the PM resume handler ? It seems configuration
> > > > could be handled in .s_stream() instead.
> > >
> > > This gets called by the s_stream() during getting the power state but I
> > > can move the dphy/misc_config to the .s_stream() of course.
> >
> > That would be nice, thanks.
> >
> > > The pll
> > > needs to be there since the device can be a clock provider e.g. for the
> > > sensor.
> >
> > OK.
> >
> > > Thanks for the review :)
> > >
> > > > > +}
> > > > > +
> > > > > +DEFINE_RUNTIME_DEV_PM_OPS(tc358746_pm_ops, tc358746_suspend,
> > > > > + tc358746_resume, NULL);
> > > > > +
> > > > > +static const struct of_device_id __maybe_unused tc358746_of_match[] = {
> > > > > + { .compatible = "toshiba,tc358746" },
> > > > > + { },
> > > > > +};
> > > > > +MODULE_DEVICE_TABLE(of, tc358746_of_match);
> > > > > +
> > > > > +static struct i2c_driver tc358746_driver = {
> > > > > + .driver = {
> > > > > + .name = "tc358746",
> > > > > + .pm = pm_ptr(&tc358746_pm_ops),
> > > > > + .of_match_table = tc358746_of_match,
> > > > > + },
> > > > > + .probe_new = tc358746_probe,
> > > > > + .remove = tc358746_remove,
> > > > > +};
> > > > > +
> > > > > +module_i2c_driver(tc358746_driver);
> > > > > +
> > > > > +MODULE_DESCRIPTION("Toshiba TC358746 Parallel to CSI-2 bridge driver");
> > > > > +MODULE_AUTHOR("Marco Felsch <kernel@pengutronix.de>");
> > > > > +MODULE_LICENSE("GPL");
--
Regards,
Laurent Pinchart
--
linux-phy mailing list
linux-phy@lists.infradead.org
https://lists.infradead.org/mailman/listinfo/linux-phy
^ permalink raw reply [flat|nested] 34+ messages in thread
* Re: [PATCH 4/4] media: tc358746: add Toshiba TC358746 Parallel to CSI-2 bridge driver
@ 2022-09-19 10:57 ` Laurent Pinchart
0 siblings, 0 replies; 34+ messages in thread
From: Laurent Pinchart @ 2022-09-19 10:57 UTC (permalink / raw)
To: Marco Felsch
Cc: mchehab, robh+dt, krzysztof.kozlowski+dt, vkoul, kishon,
sakari.ailus, hverkuil, jacopo, linux-kernel, linux-phy,
devicetree, linux-media, kernel
Hi Marco,
On Mon, Sep 19, 2022 at 10:40:38AM +0200, Marco Felsch wrote:
> On 22-09-16, Laurent Pinchart wrote:
> > On Thu, Sep 15, 2022 at 06:54:04PM +0200, Marco Felsch wrote:
> > > On 22-09-05, Laurent Pinchart wrote:
> > > > On Thu, Aug 18, 2022 at 04:33:07PM +0200, Marco Felsch wrote:
> > > > > Adding support for the TC358746 parallel <-> MIPI CSI bridge. This chip
> > > > > supports two operating modes:
> > > > > 1st) parallel-in -> mipi-csi out
> > > > > 2nd) mipi-csi in -> parallel out
> > > > >
> > > > > This patch only adds the support for the 1st mode.
> > > > >
> > > > > Signed-off-by: Marco Felsch <m.felsch@pengutronix.de>
> > > > > ---
> > > > > drivers/media/i2c/Kconfig | 17 +
> > > > > drivers/media/i2c/Makefile | 1 +
> > > > > drivers/media/i2c/tc358746.c | 1645 ++++++++++++++++++++++++++++++++++
> > > > > 3 files changed, 1663 insertions(+)
> > > > > create mode 100644 drivers/media/i2c/tc358746.c
> >
> > [snip]
> >
> > > > > diff --git a/drivers/media/i2c/tc358746.c b/drivers/media/i2c/tc358746.c
> > > > > new file mode 100644
> > > > > index 000000000000..7b71d0cf72a9
> > > > > --- /dev/null
> > > > > +++ b/drivers/media/i2c/tc358746.c
> >
> > [snip]
> >
> > > > > +struct tc358746 {
> > > > > + struct v4l2_subdev sd;
> > > > > + struct media_pad pads[TC358746_NR_PADS];
> > > > > + struct v4l2_async_notifier notifier;
> > > > > + struct v4l2_mbus_framefmt mbusfmt;
> > > >
> > > > Could you use the active state API instead of manually storing mbusfmt
> > > > here ? It involves
> > >
> > > I will do that, thanks for the hint and it also elimates a few basic
> > > checks like the pad-num check.
> >
> > Even nicer :-)
> >
> > > > - Implementing the .init_cfg() operation
> > > > - Calling v4l2_subdev_init_finalize() in probe
> > > > - Replacing calls to __tc358746_get_pad_format() with
> > > > v4l2_subdev_get_pad_format()
> > > > - Propagating the format from sink to source in tc358746_set_fmt()
> > > > - Dropping tc358746_src_mbus_code() from tc358746_get_fmt() and simply
> > > > retrieving the format using v4l2_subdev_get_pad_format() there
> > > > - Dropping this field
> > > >
> > > > The formats for both the ACTIVE and TRY states will then be stored in
> > > > the subdev state, unconditionally. You can retrieve the active state
> > > > with v4l2_subdev_get_locked_active_state() in tc358746_s_stream().
> > > >
> > > > > + struct v4l2_fwnode_endpoint csi_vep;
> > > > > +
> > > > > + struct v4l2_ctrl_handler ctrl_hdl;
> > > > > +
> > > > > + struct regmap *regmap;
> > > > > + struct clk *refclk;
> > > > > + struct gpio_desc *reset_gpio;
> > > > > + struct regulator_bulk_data supplies[ARRAY_SIZE(tc358746_supplies)];
> > > > > +
> > > > > + struct clk_hw mclk_hw;
> > > > > + unsigned long mclk_rate;
> > > > > + u8 mclk_prediv;
> > > > > + u16 mclk_postdiv;
> > > > > +
> > > > > + unsigned long pll_rate;
> > > > > + u8 pll_post_div;
> > > > > + u16 pll_pre_div;
> > > > > + u16 pll_mul;
> > > > > +
> > > > > + struct v4l2_ctrl *sensor_pclk_ctrl;
> > > > > +
> > > > > +#define TC358746_VB_MAX_SIZE (511 * 32)
> > > > > +#define TC358746_VB_DEFAULT_SIZE (1 * 32)
> > > > > + unsigned int vb_size; /* Video buffer size in bits */
> > > > > +
> > > > > + struct phy_configure_opts_mipi_dphy dphy_cfg;
> > > > > +};
> >
> > [snip]
> >
> > > > > +#ifndef MHZ
> > > >
> > > > Where would it be previously defined ? This sounds like asking for
> > > > trouble later.
> > >
> > > Sorry I don't get that, do you mean that I should define it at the very
> > > beginning?
> >
> > I mean that either MHZ is defined somewhere in the kernel already, in
> > case we should include the corresponding header, or it's not, and I
> > wouldn't add an #ifndev here. Otherwise, if someone adds a MHZ macro
> > later that gets pulled in through one of the kernel headers used by the
> > driver, it may cause subtle bugs if the definition is different. Of
> > course nobody will
> >
> > #define MHZ 42
> >
> > but we could get
> >
> > #define MHZ 1000 * 1000
> >
> > and something could break here. I'd drop the #ifndef to get the compiler
> > to complain if there's a redefinition.
>
> Argh.. sorry, now I see what you meant. I have read it like "I'm asking
> for troubles" because I'm defining it. Didn't saw that your comment was
> only related to the ifndef guard, sure I can drop it.
>
> > > > > +#define MHZ (1000 * 1000)
> > > > > +#endif
> >
> > [snip]
> >
> > > > > +static int
> > > > > +tc358746_link_validate(struct v4l2_subdev *sd, struct media_link *link,
> > > > > + struct v4l2_subdev_format *source_fmt,
> > > > > + struct v4l2_subdev_format *sink_fmt)
> > > > > +{
> > > > > + struct tc358746 *tc358746 = to_tc358746(sd);
> > > > > + unsigned long csi_bitrate, sensor_bitrate;
> > > > > + const struct tc358746_format *fmt;
> > > > > + unsigned int fifo_sz, tmp, n;
> > > > > + s64 sensor_pclk_rate;
> > > > > +
> > > > > + /* Check the FIFO settings */
> > > > > + fmt = tc358746_get_format_by_code(TC358746_SINK, tc358746->mbusfmt.code);
> > > > > + if (IS_ERR(fmt))
> > > > > + return PTR_ERR(fmt);
> > > > > +
> > > > > + sensor_pclk_rate = v4l2_ctrl_g_ctrl_int64(tc358746->sensor_pclk_ctrl);
> > > > > + sensor_bitrate = sensor_pclk_rate * fmt->bus_width;
> > > > > +
> > > > > + csi_bitrate = tc358746->dphy_cfg.lanes * tc358746->pll_rate;
> > > > > +
> > > > > + dev_dbg(tc358746->sd.dev,
> > > > > + "Fifo settings params: sensor-bitrate:%lu csi-bitrate:%lu",
> > > > > + sensor_bitrate, csi_bitrate);
> > > > > +
> > > > > + /* Avoid possible FIFO overflows */
> > > > > + if (csi_bitrate < sensor_bitrate) {
> > > > > + dev_err(sd->dev,
> > > > > + "Link validation failed csi-bitrate:%lu < sensor-bitrate:%lu\n",
> > > > > + csi_bitrate, sensor_bitrate);
> > > > > + return -EINVAL;
> > > > > + }
> > > > > +
> > > > > + /* Best case */
> > > > > + if (csi_bitrate == sensor_bitrate) {
> > > > > + tc358746->vb_size = TC358746_VB_DEFAULT_SIZE;
> > > > > + goto out;
> > > > > + }
> > > > > +
> > > > > + /*
> > > > > + * Avoid possible FIFO underflow in case of
> > > > > + * csi_bitrate > sensor_bitrate. For such case the chip has a internal
> > > > > + * fifo which can be used to delay the line output.
> > > > > + *
> > > > > + * Fifo size calculation:
> > > > > + *
> > > > > + * fifo-sz, image-width - in bits
> > > > > + * sbr - sensor_bitrate in bits/s
> > > > > + * csir - csi_bitrate in bits/s
> > > > > + *
> > > > > + * 1 1 1
> > > > > + * image-width * --- + fifo-sz --- >= ---- * image-width
> > > > > + * sbr sbr csir
> > > > > + *
> > > > > + * fifo-sz >= abs(sbr/csir * image-width - image-width)
> > > > > + * `-----´
> > > > > + * n
> > > > > + *
> > > > > + */
> > > > > +
> > > > > + sensor_bitrate /= TC358746_PRECISION;
> > > > > + n = csi_bitrate / sensor_bitrate;
> > > > > + tmp = (tc358746->mbusfmt.width * TC358746_PRECISION) / n;
> > > > > + fifo_sz = tc358746->mbusfmt.width - tmp;
> > > > > + fifo_sz *= fmt->bpp;
> > > > > + tc358746->vb_size = round_up(fifo_sz, 32);
> > > > > +
> > > >
> > > > Please also call v4l2_subdev_link_validate_default() here.
> > >
> > > Did it in my internal prepared v2 ^^ I call it now at the very
> > > beginning of this function.
> > >
> > > > I wonder if the above calculation wouldn't be better performed in
> > > > .s_stream() (or rather in a function being called by .s_stream()) when
> > > > enabling streaming.
> > >
> > > No I wouldn't shift that, since the link validation is in IMHO the
> > > correct place to inform the user that the pipeline can't negotiate if
> > > the fifo can't be configured correctly. Therefore I placed it here.
> >
> > The issue is that the user could enable the link first, and then change
> > the V4L2_CID_LINK_FREQ of the sensor and push the pixel rate above what
> > the TC358746 can support. Given the model that configures subdevs
> > independently, you can only validate the pipeline at stream on time.
>
> The .link_validate() gets called during the media-pipeline
> .link_validate() call which is called by __media_pipeline_start(). The
> function description for this function is: "Mark a pipeline as
> streaming". So I assume that it is called right in front of the
> .s_stream() call and there are no further adaptions on the
> V4L2_CID_LINK_FREQ allowed.
You're right, I mistook link validation for link setup. It should be
fine then, although the subdev core currently doesn't correctly enforce
that the link frequency won't change. This needs to be addressed in the
core (and will likely then require changes in drivers), but that's not
an issue for this patch.
> > > > > +out:
> > > > > + dev_dbg(tc358746->sd.dev,
> > > > > + "Found FIFO size[bits]:%u -> aligned to size[bits]:%u\n",
> > > > > + fifo_sz, tc358746->vb_size);
> > > > > +
> > > > > + return tc358746->vb_size > TC358746_VB_MAX_SIZE ? -EINVAL : 0;
> > > > > +}
> >
> > [snip]
> >
> > > > > +static int tc358746_probe(struct i2c_client *client)
> > > > > +{
> > > > > + struct clk_init_data mclk_initdata = { };
> > > > > + struct device *dev = &client->dev;
> > > > > + struct v4l2_fwnode_endpoint *vep;
> > > > > + unsigned long csi_link_rate;
> > > > > + struct tc358746 *tc358746;
> > > > > + struct fwnode_handle *ep;
> > > > > + unsigned char csi_lanes;
> > > > > + struct v4l2_subdev *sd;
> > > > > + struct v4l2_ctrl *ctrl;
> > > > > + unsigned long refclk;
> > > > > + unsigned int i;
> > > > > + int err;
> > > > > + u32 val;
> > > > > +
> > > > > + tc358746 = devm_kzalloc(&client->dev, sizeof(*tc358746), GFP_KERNEL);
> > > > > + if (!tc358746)
> > > > > + return -ENOMEM;
> > > > > +
> > > > > + tc358746->regmap = devm_regmap_init_i2c(client, &tc358746_regmap_config);
> > > > > + if (IS_ERR(tc358746->regmap))
> > > > > + return dev_err_probe(dev, PTR_ERR(tc358746->regmap),
> > > > > + "Failed to init regmap\n");
> > > > > +
> > > > > + tc358746->refclk = devm_clk_get(dev, "refclk");
> > > > > + if (IS_ERR(tc358746->refclk))
> > > > > + return dev_err_probe(dev, PTR_ERR(tc358746->refclk),
> > > > > + "Failed to get refclk\n");
> > > > > +
> > > > > + err = clk_prepare_enable(tc358746->refclk);
> > > > > + if (err)
> > > > > + return dev_err_probe(dev, err,
> > > > > + "Failed to enable refclk\n");
> > > > > +
> > > > > + refclk = clk_get_rate(tc358746->refclk);
> > > > > + clk_disable_unprepare(tc358746->refclk);
> > > > > +
> > > > > + if (refclk < 6 * MHZ || refclk > 40 * MHZ)
> > > > > + return dev_err_probe(dev, -EINVAL, "Invalid refclk range\n");
> > > > > +
> > > > > + for (i = 0; i < ARRAY_SIZE(tc358746_supplies); i++)
> > > > > + tc358746->supplies[i].supply = tc358746_supplies[i];
> > > > > +
> > > > > + err = devm_regulator_bulk_get(dev, ARRAY_SIZE(tc358746_supplies),
> > > > > + tc358746->supplies);
> > > > > + if (err)
> > > > > + return dev_err_probe(dev, err, "Failed to get supplies\n");
> > > > > +
> > > > > + tc358746->reset_gpio = devm_gpiod_get_optional(dev, "reset",
> > > > > + GPIOD_OUT_HIGH);
> > > > > + if (IS_ERR(tc358746->reset_gpio))
> > > > > + return dev_err_probe(dev, PTR_ERR(tc358746->reset_gpio),
> > > > > + "Failed to get reset-gpios\n");
> > > > > +
> > > > > + sd = &tc358746->sd;
> > > > > + v4l2_i2c_subdev_init(sd, client, &tc358746_ops);
> > > > > + sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
> > > > > + sd->entity.function = MEDIA_ENT_F_VID_IF_BRIDGE;
> > > > > + sd->entity.ops = &tc358746_entity_ops;
> > > > > +
> > > > > + tc358746->pads[TC358746_SINK].flags = MEDIA_PAD_FL_SINK;
> > > > > + tc358746->pads[TC358746_SOURCE].flags = MEDIA_PAD_FL_SOURCE;
> > > > > + err = media_entity_pads_init(&sd->entity, TC358746_NR_PADS,
> > > > > + tc358746->pads);
> > > > > + if (err)
> > > > > + return dev_err_probe(dev, err,
> > > > > + "Failed to setup media-entity pads\n");
> > > > > +
> > > > > + ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(dev), TC358746_SOURCE,
> > > > > + 0, 0);
> > > > > + if (!ep) {
> > > > > + dev_err(dev, "Missing endpoint node\n");
> > > > > + err = -EINVAL;
> > > > > + goto err_mc;
> > > > > + }
> > > > > +
> > > > > + /* Currently we only support 'parallel in' -> 'csi out' */
> > > > > + vep = &tc358746->csi_vep;
> > > > > + vep->bus_type = V4L2_MBUS_CSI2_DPHY;
> > > > > + err = v4l2_fwnode_endpoint_alloc_parse(ep, vep);
> > > > > + fwnode_handle_put(ep);
> > > > > + if (err) {
> > > > > + dev_err(dev, "Failed to parse source endpoint\n");
> > > > > + goto err_mc;
> > > > > + }
> > > > > +
> > > > > + csi_lanes = vep->bus.mipi_csi2.num_data_lanes;
> > > > > + if (csi_lanes == 0 || csi_lanes > 4 ||
> > > > > + vep->nr_of_link_frequencies == 0) {
> > > > > + dev_err(dev, "error: Invalid CSI-2 settings\n");
> > > > > + err = -EINVAL;
> > > > > + goto err_vep;
> > > > > + }
> > > > > +
> > > > > + /* TODO: Add support to handle multiple link frequencies */
> > > > > + csi_link_rate = (unsigned long)vep->link_frequencies[0];
> > > > > + tc358746->pll_rate = tc358746_find_pll_settings(tc358746, refclk,
> > > > > + csi_link_rate * 2);
> > > > > + if (!tc358746->pll_rate) {
> > > > > + err = -EINVAL;
> > > > > + goto err_vep;
> > > > > + }
> > > > > +
> > > > > + err = phy_mipi_dphy_get_default_config_for_hsclk(tc358746->pll_rate,
> > > > > + csi_lanes,
> > > > > + &tc358746->dphy_cfg);
> > > > > + if (err)
> > > > > + goto err_vep;
> > > > > +
> > > > > + tc358746->mbusfmt = tc358746_def_fmt;
> > > > > + tc358746->vb_size = TC358746_VB_DEFAULT_SIZE;
> > > > > +
> > > > > + dev_set_drvdata(dev, tc358746);
> > > > > + pm_runtime_set_autosuspend_delay(dev, 200);
> > > > > + pm_runtime_use_autosuspend(dev);
> > > > > + pm_runtime_enable(dev);
> > > > > +
> > > > > + err = pm_runtime_resume_and_get(dev);
> > > > > + if (err < 0) {
> > > > > + dev_err(dev, "Failed to resume the device\n");
> > > > > + goto err_vep;
> > > > > + }
> > > > > +
> > > > > + /* Ensure that CSI interface is put into LP-11 state */
> > > > > + err = tc358746_sw_reset(tc358746);
> > > > > + if (err) {
> > > > > + pm_runtime_put_noidle(dev);
> > > > > + dev_err(dev, "Failed to reset the device\n");
> > > > > + goto err_pm;
> > > > > + }
> > > > > +
> > > > > + err = tc358746_read(tc358746, CHIPID_REG, &val);
> > > > > + pm_runtime_mark_last_busy(dev);
> > > > > + pm_runtime_put_sync_autosuspend(dev);
> > > > > + if (err) {
> > > > > + dev_err(dev, "Failed to read chipid\n");
> > > > > + err = -ENODEV;
> > > > > + goto err_pm;
> > > > > + }
> > > > > +
> > > > > + if (FIELD_GET(CHIPID, val) != 0x44) {
> > > > > + dev_err(dev, "Invalid chipid 0x%02x\n",
> > > > > + (u32)FIELD_GET(CHIPID, val));
> > > > > + err = -ENODEV;
> > > > > + goto err_pm;
> > > > > + }
> > > > > +
> > > > > + /* Optional MCLK provider support */
> > > > > + if (device_property_present(dev, "#clock-cells")) {
> > > > > + const char *mclk_name;
> > > > > +
> > > > > + /* Init to highest possibel MCLK */
> > > > > + tc358746->mclk_postdiv = 512;
> > > > > + tc358746->mclk_prediv = 8;
> > > > > +
> > > > > + mclk_name = "tc358746-mclk";
> > > > > + device_property_read_string(dev, "clock-output-names",
> > > > > + &mclk_name);
> > > > > +
> > > > > + mclk_initdata.name = mclk_name;
> > > > > + mclk_initdata.ops = &tc358746_mclk_ops;
> > > > > + tc358746->mclk_hw.init = &mclk_initdata;
> > > > > +
> > > > > + err = devm_clk_hw_register(dev, &tc358746->mclk_hw);
> > > > > + if (err) {
> > > > > + dev_err(dev, "Failed to register mclk provider\n");
> > > > > + goto err_pm;
> > > > > + }
> > > > > +
> > > > > + err = devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get,
> > > > > + &tc358746->mclk_hw);
> > > > > + if (err) {
> > > > > + dev_err(dev, "Failed to add mclk provider\n");
> > > > > + goto err_pm;
> > > > > + }
> > > > > + }
> > > > > +
> > > > > + v4l2_ctrl_handler_init(&tc358746->ctrl_hdl, 1);
> > > > > +
> > > > > + ctrl = v4l2_ctrl_new_int_menu(&tc358746->ctrl_hdl, NULL,
> > > > > + V4L2_CID_LINK_FREQ, 0, 0,
> > > > > + vep->link_frequencies);
> > > > > + if (ctrl)
> > > > > + ctrl->flags |= V4L2_CTRL_FLAG_READ_ONLY;
> > > > > +
> > > > > + tc358746->sd.ctrl_handler = &tc358746->ctrl_hdl;
> > > > > + if (tc358746->ctrl_hdl.error) {
> > > > > + err = tc358746->ctrl_hdl.error;
> > > > > + goto err_pm;
> > > > > + }
> > > > > +
> > > > > + v4l2_ctrl_handler_setup(&tc358746->ctrl_hdl);
> > > > > +
> > > > > + err = tc358746_async_register(tc358746);
> > > > > + if (err < 0)
> > > > > + goto err_ctrl;
> > > > > +
> > > > > + dev_info(dev, "%s found @ 0x%x (%s)\n", client->name,
> > > > > + client->addr, client->adapter->name);
> > > >
> > > > I'd skip this to avoid adding noise to the kernel log at boot time. I
> > > > would also probably split some of the code out of the probe function as
> > > > it's fairly large. Up to you.
> > >
> > > Yes it is large but most of it is just requesting stuff and so..
> > > Therefore I kept it here since I don't need it elsewhere. What about
> > > setting it to dev_dbg()? Sometimes it can be useful e.g. to find the
> > > problem why /dev/media is not comming up..
> >
> > I find that enabling dev_dbg() messages from drivers/base/dd.c are
> > helpful for that, but a dev_dbg() message here is fine too.
>
> Ah okay, didn't checked that deep. I can remove it if you want, in my v2
> I changed it to dev_dbg().
>
> > > > > +
> > > > > + return 0;
> > > > > +
> > > > > +err_ctrl:
> > > > > + v4l2_ctrl_handler_free(&tc358746->ctrl_hdl);
> > > > > +err_pm:
> > > > > + pm_runtime_disable(dev);
> > > > > + pm_runtime_set_suspended(dev);
> > > > > + pm_runtime_dont_use_autosuspend(dev);
> > > > > +err_vep:
> > > > > + v4l2_fwnode_endpoint_free(vep);
> > > > > +err_mc:
> > > > > + media_entity_cleanup(&sd->entity);
> > > > > +
> > > > > + return err;
> > > > > +}
> > > > > +
> > > > > +static int tc358746_remove(struct i2c_client *client)
> > > > > +{
> > > > > + struct v4l2_subdev *sd = i2c_get_clientdata(client);
> > > > > + struct tc358746 *tc358746 = to_tc358746(sd);
> > > > > +
> > > > > + v4l2_ctrl_handler_free(&tc358746->ctrl_hdl);
> > > > > + v4l2_fwnode_endpoint_free(&tc358746->csi_vep);
> > > > > + v4l2_async_nf_unregister(&tc358746->notifier);
> > > > > + v4l2_async_nf_cleanup(&tc358746->notifier);
> > > > > + v4l2_async_unregister_subdev(sd);
> > > > > + v4l2_device_unregister_subdev(sd);
> > > >
> > > > This shouldn't be needed v4l2_async_unregister_subdev() should be
> > > > enough.
> > >
> > > Okay, thanks. There are a lot of unregister helpers in the v4l2 space..
> >
> > Too many of them indeed. I'd like to simplify all that.
>
> *Thumbs up*
>
> I already pushed my v2 which needs little rework due to
> kernel-test-robot findings so I will send a v3. So if there are any
> further findings let's move on to the v2.
>
> > > > > + media_entity_cleanup(&sd->entity);
> > > > > +
> > > > > + pm_runtime_disable(sd->dev);
> > > > > + pm_runtime_set_suspended(sd->dev);
> > > > > + pm_runtime_dont_use_autosuspend(sd->dev);
> > > > > +
> > > > > + return 0;
> > > > > +}
> > > > > +
> > > > > +static int tc358746_suspend(struct device *dev)
> > > > > +{
> > > > > + struct tc358746 *tc358746 = dev_get_drvdata(dev);
> > > > > +
> > > > > + clk_disable_unprepare(tc358746->refclk);
> > > > > +
> > > > > + return regulator_bulk_disable(ARRAY_SIZE(tc358746_supplies),
> > > > > + tc358746->supplies);
> > > >
> > > > Shouldn't you reenable the clock if this fails ?
> > >
> > > Hm.. if this fails I could end in a undefined chip state. But I got the
> > > point that the framework would be in a bad state if it tries again to
> > > suspend the device.
> >
> > It would be, and without a way to recover, so that could be an issue.
> >
> > > > > +}
> > > > > +
> > > > > +static int tc358746_resume(struct device *dev)
> > > > > +{
> > > > > + struct tc358746 *tc358746 = dev_get_drvdata(dev);
> > > > > + int err;
> > > > > +
> > > > > + gpiod_set_value(tc358746->reset_gpio, 1);
> > > > > +
> > > > > + err = regulator_bulk_enable(ARRAY_SIZE(tc358746_supplies),
> > > > > + tc358746->supplies);
> > > > > + if (err)
> > > > > + return err;
> > > > > +
> > > > > + /* min. 200ns */
> > > > > + usleep_range(10, 20);
> > > > > +
> > > > > + gpiod_set_value(tc358746->reset_gpio, 0);
> > > > > +
> > > > > + err = clk_prepare_enable(tc358746->refclk);
> > > > > + if (err)
> > > > > + return err;
> > > >
> > > > The regulators need to be disabled in case of failure here and below
> > > > (and so does the clock below).
> > >
> > > Yes, you're right.
> > >
> > > > > +
> > > > > + /* min. 700us ... 1ms */
> > > > > + usleep_range(1000, 1500);
> > > > > +
> > > > > + /* Sync state */
> > > > > + err = tc358746_apply_pll_config(tc358746);
> > > > > + if (err)
> > > > > + return err;
> > > > > +
> > > > > + err = tc358746_apply_dphy_config(tc358746);
> > > > > + if (err)
> > > > > + return err;
> > > > > +
> > > > > + return tc358746_apply_misc_config(tc358746);
> > > >
> > > > Does all this belong to the PM resume handler ? It seems configuration
> > > > could be handled in .s_stream() instead.
> > >
> > > This gets called by the s_stream() during getting the power state but I
> > > can move the dphy/misc_config to the .s_stream() of course.
> >
> > That would be nice, thanks.
> >
> > > The pll
> > > needs to be there since the device can be a clock provider e.g. for the
> > > sensor.
> >
> > OK.
> >
> > > Thanks for the review :)
> > >
> > > > > +}
> > > > > +
> > > > > +DEFINE_RUNTIME_DEV_PM_OPS(tc358746_pm_ops, tc358746_suspend,
> > > > > + tc358746_resume, NULL);
> > > > > +
> > > > > +static const struct of_device_id __maybe_unused tc358746_of_match[] = {
> > > > > + { .compatible = "toshiba,tc358746" },
> > > > > + { },
> > > > > +};
> > > > > +MODULE_DEVICE_TABLE(of, tc358746_of_match);
> > > > > +
> > > > > +static struct i2c_driver tc358746_driver = {
> > > > > + .driver = {
> > > > > + .name = "tc358746",
> > > > > + .pm = pm_ptr(&tc358746_pm_ops),
> > > > > + .of_match_table = tc358746_of_match,
> > > > > + },
> > > > > + .probe_new = tc358746_probe,
> > > > > + .remove = tc358746_remove,
> > > > > +};
> > > > > +
> > > > > +module_i2c_driver(tc358746_driver);
> > > > > +
> > > > > +MODULE_DESCRIPTION("Toshiba TC358746 Parallel to CSI-2 bridge driver");
> > > > > +MODULE_AUTHOR("Marco Felsch <kernel@pengutronix.de>");
> > > > > +MODULE_LICENSE("GPL");
--
Regards,
Laurent Pinchart
^ permalink raw reply [flat|nested] 34+ messages in thread
end of thread, other threads:[~2022-09-19 11:00 UTC | newest]
Thread overview: 34+ messages (download: mbox.gz / follow: Atom feed)
-- links below jump to the message on this page --
2022-08-18 14:33 [PATCH 0/4] Add support for Toshiba TC358746 Marco Felsch
2022-08-18 14:33 ` Marco Felsch
2022-08-18 14:33 ` [PATCH 1/4] phy: dphy: refactor get_default_config Marco Felsch
2022-08-18 14:33 ` Marco Felsch
2022-09-02 17:45 ` Vinod Koul
2022-09-02 17:45 ` Vinod Koul
2022-08-18 14:33 ` [PATCH 2/4] phy: dphy: add support to calculate the timing based on hs_clk_rate Marco Felsch
2022-08-18 14:33 ` Marco Felsch
2022-09-02 17:45 ` Vinod Koul
2022-09-02 17:45 ` Vinod Koul
2022-08-18 14:33 ` [PATCH 3/4] media: dt-bindings: add bindings for Toshiba TC358746 Marco Felsch
2022-08-18 14:33 ` Marco Felsch
2022-08-22 18:11 ` Rob Herring
2022-08-22 18:11 ` Rob Herring
2022-09-04 22:35 ` Laurent Pinchart
2022-09-04 22:35 ` Laurent Pinchart
2022-09-15 13:19 ` Marco Felsch
2022-09-15 13:19 ` Marco Felsch
2022-09-16 13:57 ` Laurent Pinchart
2022-09-16 13:57 ` Laurent Pinchart
2022-08-18 14:33 ` [PATCH 4/4] media: tc358746: add Toshiba TC358746 Parallel to CSI-2 bridge driver Marco Felsch
2022-08-18 14:33 ` Marco Felsch
2022-09-05 20:03 ` Laurent Pinchart
2022-09-05 20:03 ` Laurent Pinchart
2022-09-15 16:54 ` Marco Felsch
2022-09-15 16:54 ` Marco Felsch
2022-09-16 14:33 ` Laurent Pinchart
2022-09-16 14:33 ` Laurent Pinchart
2022-09-19 8:40 ` Marco Felsch
2022-09-19 8:40 ` Marco Felsch
2022-09-19 10:57 ` Laurent Pinchart
2022-09-19 10:57 ` Laurent Pinchart
2022-08-31 8:14 ` [PATCH 0/4] Add support for Toshiba TC358746 Marco Felsch
2022-08-31 8:14 ` Marco Felsch
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.