* [PATCH 0/3] Add ITE IT61620 MIPI DSI to HDMI bridge driver
@ 2025-07-14 3:14 Pet Weng
2025-07-14 3:14 ` [PATCH 1/3] dt-binding: display: Add a device tree binding for the ITE IT61620 MIPI DSI to HDMI bridge Pet Weng
` (2 more replies)
0 siblings, 3 replies; 7+ messages in thread
From: Pet Weng @ 2025-07-14 3:14 UTC (permalink / raw)
To: Andrzej Hajda, Neil Armstrong, Robert Foss, Laurent Pinchart,
Jonas Karlman, Jernej Skrabec, Maarten Lankhorst, Maxime Ripard,
Thomas Zimmermann, David Airlie, Simona Vetter, Rob Herring,
Krzysztof Kozlowski, Conor Dooley
Cc: dri-devel, devicetree, linux-kernel, Hermes Wu, Kenneth Hung,
Pet Weng, Pin-yen Lin
This patch series adds support for the ITE IT61620 MIPI DSI to HDMI
bridge chip.
The IT61620 is an I2C-controlled bridge that receives MIPI DSI input
and outputs HDMI signals. A single-port MIPI DSI input is converted to
an HDMI 1.4 output. This series introduces:
- A device tree binding YAML file describing the hardware
- A new DRM bridge driver implementing the basic functionality
- A MAINTAINERS entry for the driver
Signed-off-by: Pet Weng <pet.weng@ite.com.tw>
---
Pet Weng (3):
dt-binding: display: Add a device tree binding for the ITE IT61620 MIPI DSI to HDMI bridge
drm/bridge: Add ITE IT61620 MIPI DSI to HDMI bridge driver
MAINTAINERS: Add entry for ITE IT61620 MIPI to HDMI bridge driver
.../bindings/display/bridge/ite,it61620.yaml | 138 +
MAINTAINERS | 8 +
drivers/gpu/drm/bridge/Kconfig | 19 +
drivers/gpu/drm/bridge/Makefile | 1 +
drivers/gpu/drm/bridge/ite-it61620.c | 3004 ++++++++++++++++++++
5 files changed, 3170 insertions(+)
---
base-commit: 9bc5f6fa631da7771f0e9ea360b31b9d2f98c95d
change-id: 20250714-it61620-0714-ab4ab4ceff29
Best regards,
--
Pet Weng <pet.weng@ite.com.tw>
^ permalink raw reply [flat|nested] 7+ messages in thread* [PATCH 1/3] dt-binding: display: Add a device tree binding for the ITE IT61620 MIPI DSI to HDMI bridge 2025-07-14 3:14 [PATCH 0/3] Add ITE IT61620 MIPI DSI to HDMI bridge driver Pet Weng @ 2025-07-14 3:14 ` Pet Weng 2025-07-15 3:37 ` Rob Herring 2025-07-14 3:14 ` [PATCH 2/3] drm/bridge: Add ITE IT61620 MIPI DSI to HDMI bridge driver Pet Weng 2025-07-14 3:14 ` [PATCH 3/3] MAINTAINERS: Add entry for ITE IT61620 MIPI " Pet Weng 2 siblings, 1 reply; 7+ messages in thread From: Pet Weng @ 2025-07-14 3:14 UTC (permalink / raw) To: Andrzej Hajda, Neil Armstrong, Robert Foss, Laurent Pinchart, Jonas Karlman, Jernej Skrabec, Maarten Lankhorst, Maxime Ripard, Thomas Zimmermann, David Airlie, Simona Vetter, Rob Herring, Krzysztof Kozlowski, Conor Dooley Cc: dri-devel, devicetree, linux-kernel, Hermes Wu, Kenneth Hung, Pet Weng, Pin-yen Lin This chip receives MIPI DSI input and outputs HDMI, and is commonly connected to SoCs via I2C and DSI. Signed-off-by: Pet Weng <pet.weng@ite.com.tw> --- .../bindings/display/bridge/ite,it61620.yaml | 138 +++++++++++++++++++++ 1 file changed, 138 insertions(+) diff --git a/Documentation/devicetree/bindings/display/bridge/ite,it61620.yaml b/Documentation/devicetree/bindings/display/bridge/ite,it61620.yaml new file mode 100644 index 0000000000000000000000000000000000000000..ff8ff390a1c0c31bb05ba0e237490cff2942cd05 --- /dev/null +++ b/Documentation/devicetree/bindings/display/bridge/ite,it61620.yaml @@ -0,0 +1,138 @@ +# SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause) +%YAML 1.2 +--- +$id: http://devicetree.org/schemas/display/bridge/ite,it61620.yaml# +$schema: http://devicetree.org/meta-schemas/core.yaml# + +title: ITE IT61620 MIPI DSI to HDMI Bridge + +maintainers: + - Pet Weng <pet.weng@ite.com.tw> + +description: | + The ITE IT61620 is a high-performance, low-power HDMI bridge that converts + MIPI DSI input to HDMI 1.4b TMDS output. It supports up to 4 lanes of MIPI + D-PHY 2.0 input at 2.5Gbps per lane (10Gbps total), compatible with DSI-2 v2.0. + + The HDMI transmitter side supports up to 4Kx2K@30Hz resolutions, and is + compliant with HDMI 1.4b and HDCP 1.4. + + For audio, the IT61620 supports up to 8-channel LPCM via I2S (multi-line or + TDM mode), with optional S/PDIF or DSD (for SACD). It supports audio + sampling rates up to 192kHz. + +allOf: + - $ref: /schemas/sound/dai-common.yaml# + +properties: + compatible: + const: ite,it61620 + + reg: + maxItems: 1 + + interrupts-extended: + maxItems: 1 + description: interrupt specifier of INT pin + + reset-gpios: + maxItems: 1 + description: gpio specifier of RESET pin + + ivdd-supply: + description: core voltage + + ovdd-supply: + description: I/O voltage + + ovdd1833-supply: + description: flexible I/O votage + + pinctrl-names: + items: + - const: default + + pinctrl-0: + maxItems: 1 + + "#sound-dai-cells": + const: 0 + + dsi-lanes: + $ref: /schemas/types.yaml#/definitions/uint32 + description: Number of DSI input lanes used (1, 2 or 4) + minimum: 1 + maximum: 4 + default: 4 + + ports: + $ref: /schemas/graph.yaml#/properties/ports + + properties: + port@0: + $ref: /schemas/graph.yaml#/$defs/port-base + description: A port node pointing to DSI host port node + + port@1: + $ref: /schemas/graph.yaml#/$defs/port-base + description: Video port for HDMI output + + required: + - port@0 + - port@1 + +required: + - compatible + - reg + - interrupts-extended + - reset-gpios + - ivdd-supply + - ovdd-supply + - ovdd1833-supply + - ports + +unevaluatedProperties: false + +examples: + - | + #include <dt-bindings/gpio/gpio.h> + #include <dt-bindings/interrupt-controller/irq.h> + + i2c { + #address-cells = <1>; + #size-cells = <0>; + + hdmibrdg: ite61620@58 { + compatible = "ite,it61620"; + reg = <0x58>; + #sound-dai-cells = <0>; + interrupts-extended = <&pio 128 IRQ_TYPE_LEVEL_LOW>; + pinctrl-names = "default"; + pinctrl-0 = <&it61620_pins>; + reset-gpios = <&pio 127 GPIO_ACTIVE_LOW>; + ivdd-supply = <&pp1000_hdmi_x>; + ovdd-supply = <&pp3300_vio28_x>; + ovdd1833-supply = <&pp1800_vcamio_x>; + dsi-lanes = <4>; + status = "okay"; + + ports { + #address-cells = <1>; + #size-cells = <0>; + + port@0 { + reg = <0>; + it61620_dsi_in: endpoint { + remote-endpoint = <&dsi_out>; + }; + }; + + port@1 { + reg = <1>; + it61620_hdmi_out: endpoint { + remote-endpoint = <&hdmi_connector_in>; + }; + }; + }; + }; + }; -- 2.34.1 ^ permalink raw reply related [flat|nested] 7+ messages in thread
* Re: [PATCH 1/3] dt-binding: display: Add a device tree binding for the ITE IT61620 MIPI DSI to HDMI bridge 2025-07-14 3:14 ` [PATCH 1/3] dt-binding: display: Add a device tree binding for the ITE IT61620 MIPI DSI to HDMI bridge Pet Weng @ 2025-07-15 3:37 ` Rob Herring 0 siblings, 0 replies; 7+ messages in thread From: Rob Herring @ 2025-07-15 3:37 UTC (permalink / raw) To: Pet Weng Cc: Andrzej Hajda, Neil Armstrong, Robert Foss, Laurent Pinchart, Jonas Karlman, Jernej Skrabec, Maarten Lankhorst, Maxime Ripard, Thomas Zimmermann, David Airlie, Simona Vetter, Krzysztof Kozlowski, Conor Dooley, dri-devel, devicetree, linux-kernel, Hermes Wu, Kenneth Hung, Pin-yen Lin On Mon, Jul 14, 2025 at 11:14:32AM +0800, Pet Weng wrote: > This chip receives MIPI DSI input and outputs HDMI, and is commonly > connected to SoCs via I2C and DSI. Drop "a device tree binding for " in the subject. You already said this is a binding at the start. > > Signed-off-by: Pet Weng <pet.weng@ite.com.tw> > --- > .../bindings/display/bridge/ite,it61620.yaml | 138 +++++++++++++++++++++ > 1 file changed, 138 insertions(+) > > diff --git a/Documentation/devicetree/bindings/display/bridge/ite,it61620.yaml b/Documentation/devicetree/bindings/display/bridge/ite,it61620.yaml > new file mode 100644 > index 0000000000000000000000000000000000000000..ff8ff390a1c0c31bb05ba0e237490cff2942cd05 > --- /dev/null > +++ b/Documentation/devicetree/bindings/display/bridge/ite,it61620.yaml > @@ -0,0 +1,138 @@ > +# SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause) > +%YAML 1.2 > +--- > +$id: http://devicetree.org/schemas/display/bridge/ite,it61620.yaml# > +$schema: http://devicetree.org/meta-schemas/core.yaml# > + > +title: ITE IT61620 MIPI DSI to HDMI Bridge > + > +maintainers: > + - Pet Weng <pet.weng@ite.com.tw> > + > +description: | > + The ITE IT61620 is a high-performance, low-power HDMI bridge that converts > + MIPI DSI input to HDMI 1.4b TMDS output. It supports up to 4 lanes of MIPI > + D-PHY 2.0 input at 2.5Gbps per lane (10Gbps total), compatible with DSI-2 v2.0. > + > + The HDMI transmitter side supports up to 4Kx2K@30Hz resolutions, and is > + compliant with HDMI 1.4b and HDCP 1.4. > + > + For audio, the IT61620 supports up to 8-channel LPCM via I2S (multi-line or > + TDM mode), with optional S/PDIF or DSD (for SACD). It supports audio > + sampling rates up to 192kHz. > + > +allOf: > + - $ref: /schemas/sound/dai-common.yaml# > + > +properties: > + compatible: > + const: ite,it61620 > + > + reg: > + maxItems: 1 > + > + interrupts-extended: Just 'interrupts' in bindings. Either works in .dts files. > + maxItems: 1 > + description: interrupt specifier of INT pin > + > + reset-gpios: > + maxItems: 1 > + description: gpio specifier of RESET pin > + > + ivdd-supply: > + description: core voltage > + > + ovdd-supply: > + description: I/O voltage > + > + ovdd1833-supply: > + description: flexible I/O votage > + > + pinctrl-names: > + items: > + - const: default > + > + pinctrl-0: > + maxItems: 1 > + > + "#sound-dai-cells": > + const: 0 > + > + dsi-lanes: > + $ref: /schemas/types.yaml#/definitions/uint32 > + description: Number of DSI input lanes used (1, 2 or 4) > + minimum: 1 > + maximum: 4 > + default: 4 There's a standard property for this in the graph binding. Use it. > + > + ports: > + $ref: /schemas/graph.yaml#/properties/ports > + > + properties: > + port@0: > + $ref: /schemas/graph.yaml#/$defs/port-base "#/properties/port" if you don't have extra properties. > + description: A port node pointing to DSI host port node > + > + port@1: > + $ref: /schemas/graph.yaml#/$defs/port-base Same here. > + description: Video port for HDMI output > + > + required: > + - port@0 > + - port@1 > + > +required: > + - compatible > + - reg > + - interrupts-extended > + - reset-gpios > + - ivdd-supply > + - ovdd-supply > + - ovdd1833-supply > + - ports > + > +unevaluatedProperties: false > + > +examples: > + - | > + #include <dt-bindings/gpio/gpio.h> > + #include <dt-bindings/interrupt-controller/irq.h> > + > + i2c { > + #address-cells = <1>; > + #size-cells = <0>; > + > + hdmibrdg: ite61620@58 { Drop unused labels and "hdmi" for the node name. > + compatible = "ite,it61620"; > + reg = <0x58>; > + #sound-dai-cells = <0>; > + interrupts-extended = <&pio 128 IRQ_TYPE_LEVEL_LOW>; > + pinctrl-names = "default"; > + pinctrl-0 = <&it61620_pins>; > + reset-gpios = <&pio 127 GPIO_ACTIVE_LOW>; > + ivdd-supply = <&pp1000_hdmi_x>; > + ovdd-supply = <&pp3300_vio28_x>; > + ovdd1833-supply = <&pp1800_vcamio_x>; > + dsi-lanes = <4>; > + status = "okay"; Drop status. > + > + ports { > + #address-cells = <1>; > + #size-cells = <0>; > + > + port@0 { > + reg = <0>; > + it61620_dsi_in: endpoint { > + remote-endpoint = <&dsi_out>; > + }; > + }; > + > + port@1 { > + reg = <1>; > + it61620_hdmi_out: endpoint { > + remote-endpoint = <&hdmi_connector_in>; > + }; > + }; > + }; > + }; > + }; > > -- > 2.34.1 > ^ permalink raw reply [flat|nested] 7+ messages in thread
* [PATCH 2/3] drm/bridge: Add ITE IT61620 MIPI DSI to HDMI bridge driver 2025-07-14 3:14 [PATCH 0/3] Add ITE IT61620 MIPI DSI to HDMI bridge driver Pet Weng 2025-07-14 3:14 ` [PATCH 1/3] dt-binding: display: Add a device tree binding for the ITE IT61620 MIPI DSI to HDMI bridge Pet Weng @ 2025-07-14 3:14 ` Pet Weng 2025-08-18 9:16 ` Pin-yen Lin 2025-07-14 3:14 ` [PATCH 3/3] MAINTAINERS: Add entry for ITE IT61620 MIPI " Pet Weng 2 siblings, 1 reply; 7+ messages in thread From: Pet Weng @ 2025-07-14 3:14 UTC (permalink / raw) To: Andrzej Hajda, Neil Armstrong, Robert Foss, Laurent Pinchart, Jonas Karlman, Jernej Skrabec, Maarten Lankhorst, Maxime Ripard, Thomas Zimmermann, David Airlie, Simona Vetter, Rob Herring, Krzysztof Kozlowski, Conor Dooley Cc: dri-devel, devicetree, linux-kernel, Hermes Wu, Kenneth Hung, Pet Weng, Pin-yen Lin This adds support for the ITE IT61620 bridge chip which converts MIPI DSI input to HDMI output. The Driver implements the basic bridge functions and integrates with the DRM bridge and connector frameworks. Supported fetures include: MIPI DSI input handling HDMI output setup Basic mode configuration I2C-based control and initialization HDCP 1.4 handling This driver will be used on platforms embedding the IT61620 for video output via HDMI from SoCs with MIPI DSI output. Signed-off-by: Pet Weng <pet.weng@ite.com.tw> --- drivers/gpu/drm/bridge/Kconfig | 19 + drivers/gpu/drm/bridge/Makefile | 1 + drivers/gpu/drm/bridge/ite-it61620.c | 3004 ++++++++++++++++++++++++++++++++++ 3 files changed, 3024 insertions(+) diff --git a/drivers/gpu/drm/bridge/Kconfig b/drivers/gpu/drm/bridge/Kconfig index b9e0ca85226a603a24f90c6879d1499f824060cb..a64ae9004197d0ae9c49f450b799cc4be253ffa9 100644 --- a/drivers/gpu/drm/bridge/Kconfig +++ b/drivers/gpu/drm/bridge/Kconfig @@ -111,6 +111,25 @@ config DRM_ITE_IT6263 help ITE IT6263 LVDS to HDMI bridge chip driver. +config DRM_ITE_IT61620 + tristate "ITE IT61620 DSI/HDMI bridge" + depends on OF + select DRM_DISPLAY_CONNECTOR + select DRM_DISPLAY_HDMI_HELPER + select DRM_DISPLAY_HDCP_HELPER + select DRM_DISPLAY_HELPER + select DRM_MIPI_DSI + select DRM_KMS_HELPER + select DRM_HDMI_HELPER + select CRYPTO + select CRYPTO_HASH + help + Driver for ITE IT61620 MIPI DSI to HDMI bridge + chip driver. + + It enables display output through HDMI when connected to a MIPI + DSI source. The bridge translates the video signals for HDMI monitors. + config DRM_ITE_IT6505 tristate "ITE IT6505 DisplayPort bridge" depends on OF diff --git a/drivers/gpu/drm/bridge/Makefile b/drivers/gpu/drm/bridge/Makefile index 245e8a27e3fc525ffe02103e4436c71313f55d9a..c6cc41ea120c9d05146bd414e3dc5e7318867057 100644 --- a/drivers/gpu/drm/bridge/Makefile +++ b/drivers/gpu/drm/bridge/Makefile @@ -11,6 +11,7 @@ tda998x-y := tda998x_drv.o obj-$(CONFIG_DRM_I2C_NXP_TDA998X) += tda998x.o obj-$(CONFIG_DRM_ITE_IT6263) += ite-it6263.o +obj-$(CONFIG_DRM_ITE_IT61620) += ite-it61620.o obj-$(CONFIG_DRM_ITE_IT6505) += ite-it6505.o obj-$(CONFIG_DRM_LONTIUM_LT8912B) += lontium-lt8912b.o obj-$(CONFIG_DRM_LONTIUM_LT9211) += lontium-lt9211.o diff --git a/drivers/gpu/drm/bridge/ite-it61620.c b/drivers/gpu/drm/bridge/ite-it61620.c new file mode 100644 index 0000000000000000000000000000000000000000..d3db2fdf3da714e54efe2d198bb814550880d45f --- /dev/null +++ b/drivers/gpu/drm/bridge/ite-it61620.c @@ -0,0 +1,3004 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright (C) 2025 ITE Tech. Inc. + */ + +#include <linux/gpio/consumer.h> +#include <linux/i2c.h> +#include <linux/module.h> +#include <linux/of.h> +#include <linux/of_irq.h> +#include <linux/of_graph.h> +#include <linux/regmap.h> +#include <linux/pm_runtime.h> +#include <drm/drm_drv.h> +#include <drm/drm_atomic_helper.h> +#include <drm/drm_bridge.h> +#include <drm/drm_probe_helper.h> +#include <drm/drm_edid.h> +#include <drm/drm_mipi_dsi.h> +#include <drm/drm_print.h> +#include <drm/display/drm_hdcp_helper.h> +#include <drm/display/drm_hdmi_helper.h> +#include <drm/display/drm_hdmi_state_helper.h> +#include <video/videomode.h> +#include <sound/hdmi-codec.h> +#include <crypto/hash.h> + +#define EDID_R_BURST_NUM 16 +#define DDC_FIFO_DEPTH 32 + +#define MIPIRX_I2C_ADDRESS (0x78 >> 1) +#define TX_I2C_ADDRESS (0xC0 >> 1) + +#define REG_CTRL_PW 0xFF + +#define REG_VENDER_ID_L 0x00 +#define REG_VENDER_ID_H 0x01 +#define REG_DEVICE_ID_L 0x02 +#define REG_DEVICE_ID_H 0x03 +#define REG_DEV_VERSION 0x04 +#define DEV_VERSION_A0 0xA0 +#define DEV_VERSION_C0 0xC0 + +#define RX_REG_BANK 0x0F +#define M_MIPIRX_BANK 0x01 + +#define RX_REG_RESET_CTRL 0x05 +#define B_REF_CLOCK_RESET BIT(3) +#define RX_REG_CLK_CTRL 0x10 +#define B_MIPI_INT_STATUS BIT(7) +#define RX_REG_D_RST 0x1A +#define B_D_RST BIT(0) +#define RX_REG_INT_STATUS_01 0x0A +#define B_INI_V_CHG BIT(0) +#define RX_REG_INT_POL 0x11 +#define RX_REG_INT_MASK 0x114 +#define B_V_CHG BIT(0) +#define RX_REG_INT_STATUS_02 0x22 +#define B_INI_V_STB BIT(5) +#define RX_REG_MPPCLKI 0x12 + +#define RX_REG_HFP_L 0x30 +#define RX_REG_HFP_H 0x31 +#define RX_REG_HSW_L 0x32 +#define RX_REG_HSW_H 0x33 +#define RX_REG_HBP_L 0x34 +#define RX_REG_HBP_H 0x35 +#define RX_REG_HDEW_L 0x36 +#define RX_REG_HDEW_H 0x37 +#define RX_REG_HTOTAL_L 0x48 +#define RX_REG_HTOTAL_H 0x49 + +#define RX_REG_SELDCLK 0x24 +#define RX_REG_VFP_L 0x3A +#define RX_REG_VFP_H 0x3B +#define RX_REG_VSW_L 0x3C +#define RX_REG_VSW_H 0x3D +#define RX_REG_VBP_L 0x3E +#define RX_REG_VBP_H 0x3F +#define RX_REG_VDEW_L 0x40 +#define RX_REG_VDEW_H 0x41 +#define RX_REG_POL 0x4E +#define B_MIPI_H_POL BIT(0) +#define B_MIPI_V_POL BIT(1) + +#define RX_REG_DSCCTRL 0x25 +#define RX_REG_SYNC_NUM 0x4D +#define RX_REG_BSP_SEL 0x1F +#define RX_REG_PWD_CTRL 0xE0 +#define RX_REG_ENVRR 0x1AC +#define RX_REG_ENVBLK 0x1AD + +#define RX_REG_D2P_RESET 0xA0 +#define RX_REG_D2P_CTRL 0xA1 +#define RX_REG_AUTO_D2P_RESET 0xA2 +#define RX_REG_TUNEOPT 0xA9 +#define RX_REG_TUNETHRE 0xAA +#define RX_REG_DSC_RESET 0xAB +#define RX_REG_DSC_VFRD 0xAC + +#define RX_REG_MIPI_CONFIG 0x112 +#define B_MIPI_LANE_NUM 0x03 +#define B_MIPI_PN_SWAP BIT(2) +#define B_MIPI_LANE_SWAP BIT(3) +#define RX_REG_HS_CTRL 0x118 +#define RX_REG_LP_CTRL 0x119 +#define RX_REG_MIPI_CTRL01 0x44 +#define RX_REG_AUTO_SYNC 0x144 +#define RX_REG_MV_MAX 0x146 +#define RX_REG_FORCE_M 0x147 +#define B_FORCE_MHT_STB BIT(0) +#define B_FORCE_MVT_STB BIT(3) +#define RX_REG_MIPI_CTRL02 0x14E +#define B_FIFO_RST BIT(5) + +#define TX_REG_STATUS01 0x07 +#define B_INT_STATUS BIT(0) +#define B_HPD_STATUS BIT(1) +#define B_VIDEO_STB BIT(2) + +#define TX_REG_HDMITX_BANK 0x0F +#define M_HDMITX_BANK 0x03 +#define B_INT_EVENT_HDMI BIT(4) +#define TX_REG_RESET_1_CTRL 0x05 +#define B_REFERENCE_CLOCK_RESET BIT(0) +#define B_VIDEO_RESET BIT(1) +#define B_AUDIO_RESET BIT(2) +#define B_AUX_RESET BIT(3) +#define B_IPCLK_RESET BIT(4) +#define B_SDM_RESET BIT(5) +#define B_TCLK_RESET BIT(6) + +#define TX_REG_RESET_2_CTRL 0x06 + +#define TX_REG_V_STS 0x09 +#define B_RXSEN BIT(1) +#define B_V_STABLE BIT(2) +#define B_TMDS_STABLE BIT(3) + +#define TX_REG_SYS_CONFIG 0x0C +#define B_EN_HDMI BIT(6) +#define B_INT_POL BIT(0) +#define B_INT_MODE BIT(1) +#define B_INT_OUT_STATUS BIT(2) +#define B_INT_OUTPUT BIT(3) + +#define BIT_OFFSET(x) ((x) * BITS_PER_BYTE) + +#define TX_REG_INT1 0x10 +#define TX_REG_INT_MASK1 0x18 +#define INT_HPD_CHG 0 +#define B_HPD_CHG BIT(INT_HPD_CHG) +#define BIT_HPD_CHG (BIT_OFFSET(0) + INT_HPD_CHG) +#define INT_RXSEN_CHANGE 2 +#define B_RXSEN_CHANGE BIT(INT_RXSEN_CHANGE) +#define BIT_RXSEN_CHANGE (BIT_OFFSET(0) + INT_RXSEN_CHANGE) +#define INT_AUTH_F 3 +#define B_INT_AUTH_F BIT(INT_AUTH_F) +#define BIT_INT_AUTH_F (BIT_OFFSET(0) + INT_AUTH_F) +#define INT_AUTH_D 4 +#define B_INT_AUTH_D BIT(INT_AUTH_D) +#define BIT_INT_AUTH_D (BIT_OFFSET(0) + INT_AUTH_D) + +#define TX_REG_INT2 0x11 +#define TX_REG_INT_MASK2 0x19 +#define INT_KSV_CHECK 1 +#define B_KSV_CHECK BIT(INT_KSV_CHECK) +#define BIT_KSV_CHECK (BIT_OFFSET(1) + INT_KSV_CHECK) + +#define TX_REG_INT3 0x16 +#define TX_REG_INT_MASK3 0x1E +#define INT_TMDS_STB_CHG 6 +#define B_TMDS_STB_CHG BIT(INT_TMDS_STB_CHG) +#define BIT_TMDS_STB_CHG (BIT_OFFSET(2) + INT_TMDS_STB_CHG) + +#define REG_TX_INT_CTRL 0x21 +#define B_DIS_INT_OUTPUT BIT(5) +#define TX_REG_CLOCK_PWD_CTRL 0x2B + +#define TX_REG_AFE0E 0x0E +#define TX_REG_AFE30 0x30 +#define TX_REG_AFE33 0x33 +#define TX_REG_AFE34 0x34 +#define TX_REG_AFE35 0x35 +#define TX_REG_AFEE9 0xE9 +#define TX_REG_AFE_XP 0x219 +#define TX_REG_AFE_XLC1 0x220 +#define TX_REG_AFE_XLC2 0x223 +#define TX_REG_AFE_XLC3 0x226 +#define TX_REG_AFE_DRV 0x23B + +#define TX_REG_CR_1_CTRL 0x3A +#define TX_REG_CR_2_CTRL 0x3F + +#define TX_REG_R0TM 0x5A +#define TX_REG_SHA_SEL 0x5D + +#define TX_REG_HDCP_CTRL1 0x60 +#define B_CPDESIRED BIT(0) +#define TX_REG_HDCP_PRO 0x61 +#define B_AUTH_FIRE BIT(0) +#define B_LIST_CHK_DONE BIT(4) +#define B_LIST_CHK_FAIL BIT(5) +#define TX_REG_HDCP_CTRL2 0x62 +#define TX_REG_AUTOMUTE 0x65 +#define B_AN_SEL BIT(0) +#define B_EN_AN_GEN BIT(1) +#define B_EN_M0_RD BIT(5) +#define TX_REG_HDCP_AUTH_CS 0x66 +#define M_AUTH_CH 0x7F +#define CS_AUTH_DONE 0x4E +#define CS_AUTH_FAIL 0x02 +#define CS_KSVLIST_CHK 0x19 +#define TX_REG_HDCP_CTRL3 0x1BA +#define B_ENC_DIS BIT(6) +#define B_PAUSE BIT(7) + +#define TX_REG_VD_CTRL1 0xA8 +#define TX_REG_VD_CTRL2 0xA4 +#define B_VIDEO_FIFO_REST BIT(0) +#define TX_REG_VD_CTRL3 0xB7 + +#define TX_REG_AUD_SPDIF 0x23 +#define TX_REG_AUD_CTRL 0xB8 +#define TX_REG_AUD_FMT 0xBA +#define TX_REG_EN_AUDIO 0xBB +#define TX_REG_AUD_FIFO1 0xBC +#define TX_REG_AUD_FIFO2 0xBD +#define TX_REG_AUD_STS1 0x1F0 +#define B_EN_AUD_NLPCM BIT(1) +#define TX_REG_AUD_STS2 0x1F3 +#define TX_REG_AUD_STS3 0x1F4 + +#define TX_REG_LINK_CTRL0 0xD3 +#define B_EN_AUDIO_MUTE BIT(5) + +#define TX_REG_V_QUEUE 0xE7 +#define TX_REG_V_TU 0xEB + +#define TX_REG_HPD_CONFIG 0xF6 + +#define TX_REG_CEC_CONFIG 0xFA +#define B_EN_CEC BIT(0) + +#define TX_REG_DDC_CTRL1 0x1A0 +#define TX_REG_DDC_ADDR 0x1A1 +#define DDC_HDCP_ADDR (DRM_HDCP_DDC_ADDR << 1) +#define DDC_EDID_ADDR (DDC_ADDR << 1) +#define TX_REG_DDC_OFFSET 0x1A2 +#define TX_REG_DDC_NUM_L 0x1A3 +#define TX_REG_DDC_NUM_H 0x1A4 +#define TX_REG_DDC_SEGMENT 0x1A5 +#define TX_REG_DDC_COMMAND 0x1A6 +#define DDC_COMMAND_BURST_R 0X00 +#define DDC_COMMAND_BURST_W 0X01 +#define DDC_COMMAND_EDID_RD 0X03 +#define DDC_COMMAND_FIFO_CLR 0X09 +#define DDC_COMMAND_ABORT 0X0F +#define TX_REG_DDC_CTRL2 0x1AD +#define B_DDC_REST BIT(4) +#define TX_REG_DDC_STATUS 0x1A7 +#define B_DDC_TX_DONE BIT(7) +#define B_DDC_NOACK BIT(5) +#define B_DDC_FULL BIT(2) +#define TX_REG_DDC_FIFO 0x1A8 +#define TX_REG_DDC_FIFO_STS 0x1AE +#define M_DDC_STAGE_NUM 0x3F + +#define TX_REG_HDMI_CTRL1 0x1B8 +#define B_EN_HDMI_MODE BIT(0) +#define TX_REG_HDMI_CTRL2 0x1B9 +#define B_EN_AVMUTE BIT(0) +#define TX_REG_EN_PKT1 0x1BF +#define B_EN_AVI BIT(0) +#define B_AVI_RP BIT(1) +#define B_EN_AUD BIT(2) +#define B_EN_AUD_RP BIT(3) +#define TX_REG_EN_PKT2 0x1C0 +#define B_EN_GEN BIT(4) +#define B_GEN_RP BIT(5) + +#define TX_REG_VH_TIME 0x165 +#define TX_REG_PG_HFP_L 0x150 +#define TX_REG_PG_HFP_H 0x151 +#define TX_REG_PG_HSW_L 0x152 +#define TX_REG_PG_HSW_H 0x153 +#define TX_REG_PG_HBP_L 0x154 +#define TX_REG_PG_HBP_H 0x155 +#define TX_REG_PG_DEW_L 0x156 +#define TX_REG_PG_DEW_H 0x157 +#define TX_REG_PG_HVR2_L 0x158 +#define TX_REG_PG_HVR2_H 0x159 +#define TX_REG_PG_VFP_L 0x15A +#define TX_REG_PG_VFP_H 0x15B +#define TX_REG_PG_VSW_L 0x15C +#define TX_REG_PG_VSW_H 0x15D +#define TX_REG_PG_VBP_L 0x15E +#define TX_REG_PG_VBP_H 0x15F +#define TX_REG_PG_VDEW_L 0x160 +#define TX_REG_PG_HDEW_H 0x161 +#define TX_REG_PG_VFP2_L 0x162 +#define TX_REG_PG_VFP2_H 0x163 +#define TX_REG_PG_POL 0x164 + +#define TX_REG_AVIINFO_DB00 0x1D0 +#define TX_REG_AVIINFO_DB01 0x1D1 +#define TX_REG_AVIINFO_DB02 0x1D2 +#define TX_REG_AVIINFO_DB03 0x1D3 +#define TX_REG_AVIINFO_DB04 0x1D4 +#define TX_REG_AVIINFO_DB05 0x1D5 +#define TX_REG_AVIINFO_DB06 0x1D6 +#define TX_REG_AVIINFO_DB07 0x1D7 +#define TX_REG_AVIINFO_DB08 0x1D8 +#define TX_REG_AVIINFO_DB09 0x1D9 +#define TX_REG_AVIINFO_DB10 0x1DA +#define TX_REG_AVIINFO_DB11 0x1DB +#define TX_REG_AVIINFO_DB12 0x1DC +#define TX_REG_AVIINFO_DB13 0x1DD +#define TX_REG_AVIINFO_DB14 0x1DE + +#define TX_REG_AUDINFO_DB01 0x1E0 +#define TX_REG_AUDINFO_DB02 0x1E1 +#define TX_REG_AUDINFO_DB03 0x1E2 +#define TX_REG_AUDINFO_DB04 0x1E3 +#define TX_REG_AUDINFO_DB05 0x1E4 +#define TX_REG_AUDINFO_DB06 0x1E5 +#define TX_REG_AUDINFO_DB07 0x1E6 +#define TX_REG_AUDINFO_DB08 0x1E7 +#define TX_REG_AUDINFO_DB09 0x1E8 +#define TX_REG_AUDINFO_DB10 0x1E9 + +#define TX_REG_SSC_PD 0x211 + +#define TX_REG_TXPLL_CTRL 0x218 +#define TX_REG_XLC_7_CTRL 0x227 + +#define TX_REG_TXDRV_PD_CTRL 0x23D +#define TX_REG_TXDRV_CTRL 0x240 +#define TX_REG_AUX_CTRL 0x244 +#define TX_REG_IPLL_CTRL 0x248 +#define TX_REG_RDROM_TRG 0x271 + +#define TX_REG_HDCP_ARI_L 0x63 +#define TX_REG_HDCP_ARI_H 0x64 + +#define TX_REG_HDCP_AUTH_STS 0x67 + +#define TX_REG_HDCP_BKSV1 0x68 +#define TX_REG_HDCP_BKSV2 0x69 +#define TX_REG_HDCP_BKSV3 0x6A +#define TX_REG_HDCP_BKSV4 0x6B +#define TX_REG_HDCP_BKSV5 0x6C + +#define TX_REG_HDCP_BRI_L 0x6D +#define TX_REG_HDCP_BRI_H 0x6E + +#define TX_REG_HDCP_AKSV1 0x6F +#define TX_REG_HDCP_AKSV2 0x70 +#define TX_REG_HDCP_AKSV3 0x71 +#define TX_REG_HDCP_AKSV4 0x72 +#define TX_REG_HDCP_AKSV5 0x73 + +#define TX_REG_ANM0V1 0x74 +#define TX_REG_ANM0V2 0x75 +#define TX_REG_ANM0V3 0x76 +#define TX_REG_HDCP_AN_M0_V4 0x77 +#define TX_REG_HDCP_AN_M05 0x78 +#define TX_REG_HDCP_AN_M06 0x79 +#define TX_REG_HDCP_AN_M07 0x7A +#define TX_REG_HDCP_AN_M08 0x7B + +#define TX_REG_HDCP_BCAPS 0x7C +#define B_KSV_READY BIT(5) +#define TX_REG_HDCP_BSTS_L 0x7D +#define TX_REG_HDCP_BSTS_H 0x7E + +#define TX_REG_AUDPKT_CTS_0 0x3A8 +#define TX_REG_AUDPKT_CTS_1 0x3A9 +#define TX_REG_AUDPKT_CTS_2 0x3AA + +#define TX_REG_AUDPKT_N_0 0x3AB +#define TX_REG_AUDPKT_N_1 0x3AC +#define TX_REG_AUDPKT_N_2 0x3AD + +#define SOFT_DDC_TIMEOUT_MS 100 + +#define MAX_HDCP_DOWN_STREAM_COUNT 127 +#define HDCP_SHA1_FIFO_LEN (MAX_HDCP_DOWN_STREAM_COUNT * DRM_HDCP_KSV_LEN + 10) + +#define HI_BYTE(x) (((x) >> 8) & 0xFF) +#define LO_BYTE(x) ((x) & 0xFF) + +enum video_state { + it61620_VIDEO_OFF = 0x00, + it61620_VIDEO_WAIT, + it61620_VIDEO_ON, +}; + +enum hdcp_state { + CP_NONE = 0x00, + CP_GOING = 0x01, +}; + +enum it61620_audio_select { + I2S = 0, + SPDIF, +}; + +enum it61620_audio_word_length { + WORD_LENGTH_16BIT = 0x0, + WORD_LENGTH_18BIT = 0x1, + WORD_LENGTH_20BIT = 0x2, + WORD_LENGTH_24BIT = 0x3, +}; + +enum it61620_audio_sample_rate { + SAMPLE_RATE_32K = 0x3, + SAMPLE_RATE_48K = 0x2, + SAMPLE_RATE_64K = 0xB, + SAMPLE_RATE_96K = 0xA, + SAMPLE_RATE_192K = 0xE, + SAMPLE_RATE_44_1K = 0x0, + SAMPLE_RATE_88_2K = 0x8, + SAMPLE_RATE_176_4K = 0xC, +}; + +enum it61620_audio_type { + LPCM = 0, + NLPCM, +}; + +struct it6162_chip_info { + u16 vid; + u16 pid; +}; + +struct it61620_audio { + enum it61620_audio_select select; + enum it61620_audio_type type; + enum it61620_audio_sample_rate sample_rate; + u8 word_length; + u8 channel_count; + u8 audfmt; + unsigned int audio_enable; + unsigned int sample_width; + unsigned int channel_number; + u8 infoframe[HDMI_INFOFRAME_SIZE(AUDIO)]; + unsigned char channel_status[AES_IEC958_STATUS_SIZE]; +}; + +struct it61620_mipirx { + u8 lane_num; + u8 pn_swap; + u8 lane_swap; +}; + +struct it61620_hdmi_afe_setting { + unsigned int clock; + unsigned int h2on_pll; + unsigned int hs; + unsigned int afe_val[24]; +}; + +struct it61620_platform_data { + struct regulator *ovdd1833; + struct regulator *ivdd; + struct regulator *ovdd33; + struct gpio_desc *gpiod_reset; +}; + +struct it61620 { + struct drm_bridge bridge; + struct drm_connector connector; + struct device *dev; + enum drm_connector_status connector_status; + struct drm_device *drm; + struct drm_bridge *next_bridge; + + struct i2c_client *it61620_i2c; + struct i2c_client *mipirx_i2c; + struct i2c_client *tx_i2c; + struct regmap *it61620_regmap; + struct regmap *mipirx_regmap; + struct regmap *tx_regmap; + + struct delayed_work hdcp_work; + struct wait_queue_head wq; + + struct it61620_platform_data pdata; + bool powered; + bool is_hdmi; + bool en_audio; + bool hpd; + u8 dev_ver; + const struct drm_edid *cached_edid; + + /* operations can only be served one at the time */ + struct mutex ddc_lock; + + enum video_state video_state; + + struct it61620_audio audio_config; + + /* it61620 DSI RX related params */ + struct mipi_dsi_device *dsi; + + struct it61620_mipirx mipirx_config; + + struct videomode vm; + + struct i2c_adapter ddc; + + enum hdcp_state hdcp_state; + u8 sha1_input[HDCP_SHA1_FIFO_LEN]; + const struct it6162_chip_info *chip_info; +}; + +static void it61620_show_drm_video_mode(struct it61620 *it61620, + const struct videomode *vm); +static void it61620_stop_hdcp_work(struct it61620 *it61620); +static void it61620_start_hdcp_work(struct it61620 *it61620); +static void it61620_hdmi_hdcp_wait_ksv_list(struct it61620 *it61620); +static inline void it61620_hdmi_enable_avmute(struct it61620 *it61620, + bool enable); + +static struct it61620 *bridge_to_it61620(struct drm_bridge *bridge) +{ + return container_of(bridge, struct it61620, bridge); +} + +static const struct regmap_config it61620_regmap_config = { + .reg_bits = 8, + .val_bits = 8, + .max_register = 0xff, + .cache_type = REGCACHE_NONE, +}; + +static const struct regmap_range it61620_tx_volatile_ranges[] = { + { .range_min = 0, .range_max = 0x3ff}, +}; + +static const struct regmap_access_table it61620_tx_volatile_table = { + .yes_ranges = it61620_tx_volatile_ranges, + .n_yes_ranges = ARRAY_SIZE(it61620_tx_volatile_ranges), +}; + +static const struct regmap_range_cfg it61620_tx_regmap_ranges[] = { + { + .range_min = 0, + .range_max = 0x3ff, + .selector_reg = TX_REG_HDMITX_BANK, + .selector_mask = M_HDMITX_BANK, + .selector_shift = 0, + .window_start = 0x00, + .window_len = 0x100, + }, +}; + +static const struct regmap_config it61620_tx_regmap_config = { + .reg_bits = 8, + .val_bits = 8, + .volatile_table = &it61620_tx_volatile_table, + .ranges = it61620_tx_regmap_ranges, + .num_ranges = ARRAY_SIZE(it61620_tx_regmap_ranges), + .max_register = 0x3FF, + .cache_type = REGCACHE_NONE, +}; + +static const struct regmap_range it61620_mipirx_volatile_ranges[] = { + { .range_min = 0, .range_max = 0x1ff }, +}; + +static const struct regmap_access_table it61620_mipirx_volatile_table = { + .yes_ranges = it61620_mipirx_volatile_ranges, + .n_yes_ranges = ARRAY_SIZE(it61620_mipirx_volatile_ranges), +}; + +static const struct regmap_range_cfg it61620_mipirx_regmap_ranges[] = { + { + .range_min = 0, + .range_max = 0x1ff, + .selector_reg = RX_REG_BANK, + .selector_mask = M_MIPIRX_BANK, + .selector_shift = 0, + .window_start = 0x00, + .window_len = 0x100, + }, +}; + +static const struct regmap_config it61620_mipi_regmap_config = { + .reg_bits = 8, + .val_bits = 8, + .volatile_table = &it61620_mipirx_volatile_table, + .ranges = it61620_mipirx_regmap_ranges, + .num_ranges = ARRAY_SIZE(it61620_mipirx_regmap_ranges), + .max_register = 0x1FF, + .cache_type = REGCACHE_NONE, +}; + +static unsigned int it61620_mipi_reg_read(struct it61620 *it61620, + unsigned int reg) +{ + unsigned int val; + int err; + struct device *dev = it61620->dev; + + if (!it61620->powered) + return -ENODEV; + + err = regmap_read(it61620->mipirx_regmap, reg, &val); + if (err < 0) { + dev_err(dev, "read failed rx reg[0x%x] err: %d", reg, err); + return err; + } + + return val; +} + +static int it61620_mipi_reg_write(struct it61620 *it61620, unsigned int reg, + unsigned int val) +{ + int err; + struct device *dev = it61620->dev; + + if (!it61620->powered) + return -ENODEV; + + err = regmap_write(it61620->mipirx_regmap, reg, val); + + if (err < 0) { + dev_err(dev, "write failed rx reg[0x%x] = 0x%x err = %d", + reg, val, err); + return err; + } + + return 0; +} + +static int it61620_mipi_reg_set(struct it61620 *it61620, unsigned int reg, + unsigned int mask, unsigned int val) +{ + int err; + struct device *dev = it61620->dev; + + if (!it61620->powered) + return -ENODEV; + + err = regmap_update_bits(it61620->mipirx_regmap, reg, mask, val); + if (err < 0) { + dev_err(dev, + "write rx reg[0x%x] = 0x%x mask = 0x%x failed err %d", + reg, val, mask, err); + return err; + } + + return 0; +} + +static unsigned int it61620_hdmi_reg_read(struct it61620 *it61620, + unsigned int reg) +{ + unsigned int val; + int err; + struct device *dev = it61620->dev; + + if (!it61620->powered) + return -ENODEV; + + err = regmap_read(it61620->tx_regmap, reg, &val); + if (err < 0) { + dev_err(dev, "read failed tx reg[0x%x] err: %d", reg, err); + return err; + } + + return val; +} + +static int it61620_hdmi_reg_write(struct it61620 *it61620, unsigned int reg, + unsigned int val) +{ + int err; + struct device *dev = it61620->dev; + + if (!it61620->powered) + return -ENODEV; + + err = regmap_write(it61620->tx_regmap, reg, val); + + if (err < 0) { + dev_err(dev, "write failed tx reg[0x%x] = 0x%x err = %d", + reg, val, err); + return err; + } + + return 0; +} + +static int it61620_hdmi_reg_set(struct it61620 *it61620, unsigned int reg, + unsigned int mask, unsigned int val) +{ + int err; + struct device *dev = it61620->dev; + + if (!it61620->powered) + return -ENODEV; + + err = regmap_update_bits(it61620->tx_regmap, reg, mask, val); + if (err < 0) { + dev_err(dev, + "write tx reg[0x%x] = 0x%x mask = 0x%x failed err %d", + reg, val, mask, err); + return err; + } + + return 0; +} + +static void it61620_mipi_reset_video(struct it61620 *it61620) +{ + it61620_mipi_reg_write(it61620, RX_REG_DSC_RESET, 0x38); + usleep_range(100, 200); + it61620_mipi_reg_set(it61620, RX_REG_D2P_RESET, 0x70, 0x70); + it61620_mipi_reg_write(it61620, RX_REG_DSC_RESET, 0x00); + + it61620_mipi_reg_set(it61620, RX_REG_RESET_CTRL, 0x57, 0x00); + usleep_range(1000, 2000); +} + +static void it61620_mipi_m2p_reset(struct it61620 *it61620) +{ + if (it61620->dev_ver != DEV_VERSION_A0) + return; + it61620_mipi_reg_set(it61620, RX_REG_MIPI_CTRL02, B_FIFO_RST, + B_FIFO_RST); + usleep_range(1000, 2000); + it61620_mipi_reg_set(it61620, RX_REG_MIPI_CTRL02, B_FIFO_RST, 0x00); +} + +static void it61620_mipi_d2p_reset_fifo(struct it61620 *it61620) +{ + it61620_mipi_reg_set(it61620, RX_REG_D2P_RESET, 0x70, 0x70); + usleep_range(1000, 2000); + it61620_mipi_reg_set(it61620, RX_REG_D2P_RESET, 0x70, 0x50); + usleep_range(100, 200); + it61620_mipi_reg_set(it61620, RX_REG_D2P_RESET, 0x70, 0x10); + usleep_range(100, 200); + it61620_mipi_reg_set(it61620, RX_REG_D2P_RESET, 0x70, 0x00); +} + +static void it61620_mipi_d2p_reset(struct it61620 *it61620) +{ + it61620_mipi_m2p_reset(it61620); + it61620_mipi_reg_set(it61620, RX_REG_D_RST, B_D_RST, B_D_RST); + usleep_range(1000, 2000); + it61620_mipi_reg_set(it61620, RX_REG_D_RST, B_D_RST, 0x00); + it61620_mipi_d2p_reset_fifo(it61620); +} + +static void it61620_mipi_reset(struct it61620 *it61620) +{ + unsigned int val; + u8 dev_ver = it61620->dev_ver; + struct it61620_mipirx *mipirx = &it61620->mipirx_config; + + it61620_mipi_reg_set(it61620, RX_REG_RESET_CTRL, B_REF_CLOCK_RESET, + B_REF_CLOCK_RESET); + usleep_range(1000, 2000); + it61620_mipi_reg_set(it61620, RX_REG_RESET_CTRL, B_REF_CLOCK_RESET, + 0x00); + usleep_range(1000, 2000); + + it61620_mipi_d2p_reset(it61620); + + it61620_mipi_reg_write(it61620, RX_REG_HS_CTRL, 0x93); + it61620_mipi_reg_write(it61620, RX_REG_LP_CTRL, 0x0C); + it61620_mipi_reg_write(it61620, RX_REG_AUTO_SYNC, 0x01); + it61620_mipi_reg_write(it61620, RX_REG_MV_MAX, 0x0F); + it61620_mipi_reg_write(it61620, RX_REG_FORCE_M, B_FORCE_MHT_STB); + + it61620_mipi_reg_write(it61620, RX_REG_MIPI_CTRL01, 0x2C); + it61620_mipi_reg_write(it61620, RX_REG_AUTO_D2P_RESET, 0x13); + it61620_mipi_reg_write(it61620, RX_REG_D2P_CTRL, 0x28); + it61620_mipi_reg_write(it61620, RX_REG_TUNEOPT, 0x9C); + + it61620_mipi_reg_set(it61620, RX_REG_CLK_CTRL, 0x30, 0x20); + + if (dev_ver != DEV_VERSION_A0) { + it61620_mipi_reg_write(it61620, RX_REG_TUNETHRE, 0x02); + it61620_mipi_reg_write(it61620, RX_REG_AUTO_D2P_RESET, 0x83); + it61620_mipi_reg_set(it61620, RX_REG_FORCE_M, B_FORCE_MVT_STB, + B_FORCE_MVT_STB); + it61620_mipi_reg_set(it61620, RX_REG_SYNC_NUM, 0xF7, 0x44); + it61620_mipi_reg_set(it61620, RX_REG_BSP_SEL, 0x03, 0x02); + it61620_mipi_reg_set(it61620, RX_REG_PWD_CTRL, 0x24, 0x24); + it61620_mipi_reg_set(it61620, RX_REG_ENVRR, 0x01, 0x00); + it61620_mipi_reg_write(it61620, RX_REG_ENVBLK, 0x00); + it61620_mipi_reg_set(it61620, RX_REG_DSCCTRL, 0x40, 0x00); + } + val = (mipirx->lane_num - 1) | + (mipirx->pn_swap ? B_MIPI_PN_SWAP : 0x00) | + (mipirx->lane_swap ? B_MIPI_LANE_SWAP : 0x00); + + it61620_mipi_reg_set(it61620, RX_REG_MIPI_CONFIG, 0x0F, val); + + it61620_mipi_reset_video(it61620); +} + +static void it61620_mipi_video_change_irq(struct it61620 *it61620) +{ + unsigned int reg22; + unsigned int video_stable; + + reg22 = it61620_mipi_reg_read(it61620, RX_REG_INT_STATUS_02); + video_stable = reg22 & B_INI_V_STB; + + if (video_stable) { + it61620_mipi_m2p_reset(it61620); + it61620_mipi_d2p_reset_fifo(it61620); + } else { + it61620_mipi_reg_set(it61620, RX_REG_D_RST, 0x01, 0x01); + usleep_range(1000, 2000); + it61620_mipi_reg_set(it61620, RX_REG_D_RST, 0x01, 0x00); + it61620_mipi_reg_set(it61620, RX_REG_D2P_RESET, 0x70, 0x70); + } +} + +static void it61620_mipi_irq_handler(struct it61620 *it61620) +{ + unsigned int reg0a, reg_val; + + reg_val = it61620_mipi_reg_read(it61620, RX_REG_CLK_CTRL) & + B_MIPI_INT_STATUS; + if (reg_val == 0) + return; + + reg0a = it61620_mipi_reg_read(it61620, RX_REG_INT_STATUS_01); + it61620_mipi_reg_write(it61620, RX_REG_INT_STATUS_01, reg0a); + if (reg0a & B_INI_V_CHG) + it61620_mipi_video_change_irq(it61620); +} + +static void it61620_mipi_set_d2v_video_timing(struct it61620 *it61620) +{ + u8 seldckval; + u32 htotal, hfp, hsw, hbp, hdew; + u32 vfp, vsw, vbp, vdew; + u32 clock; + bool hpol_high = 0, vpol_high = 0; + struct videomode *vm = &it61620->vm; + + it61620_show_drm_video_mode(it61620, &it61620->vm); + + if (vm->flags & DISPLAY_FLAGS_HSYNC_HIGH) + hpol_high = true; + + if (vm->flags & DISPLAY_FLAGS_VSYNC_HIGH) + vpol_high = true; + + clock = vm->pixelclock / 1000; + hdew = vm->hactive; + + hfp = vm->hfront_porch; + hsw = vm->hsync_len; + hbp = vm->hback_porch; + htotal = vm->hactive + vm->hfront_porch + vm->hsync_len + + vm->hback_porch; + + vdew = vm->vactive; + vfp = vm->vfront_porch; + vsw = vm->vsync_len; + vbp = vm->vback_porch; + + if (it61620->dev_ver != DEV_VERSION_A0) { + if (it61620->dev_ver == DEV_VERSION_C0) { + seldckval = 0x04; + } else { + if (clock > 270000) + seldckval = 0x0C; + else + seldckval = 0x18; + } + it61620_mipi_reg_set(it61620, RX_REG_SELDCLK, 0x1C, seldckval); + } + + if (hdew > 2000) + it61620_mipi_reg_write(it61620, RX_REG_DSC_VFRD, 0x50); + else + it61620_mipi_reg_write(it61620, RX_REG_DSC_VFRD, hdew / 36); + + it61620_mipi_reg_write(it61620, RX_REG_HFP_L, LO_BYTE(hfp)); + it61620_mipi_reg_write(it61620, RX_REG_HFP_H, HI_BYTE(hfp)); + + it61620_mipi_reg_write(it61620, RX_REG_HSW_L, LO_BYTE(hsw)); + it61620_mipi_reg_write(it61620, RX_REG_HSW_H, HI_BYTE(hsw)); + + it61620_mipi_reg_write(it61620, RX_REG_HBP_L, LO_BYTE(hbp)); + it61620_mipi_reg_write(it61620, RX_REG_HBP_H, HI_BYTE(hbp)); + + it61620_mipi_reg_write(it61620, RX_REG_HDEW_L, LO_BYTE(hdew)); + it61620_mipi_reg_write(it61620, RX_REG_HDEW_H, HI_BYTE(hdew)); + + it61620_mipi_reg_write(it61620, RX_REG_HTOTAL_L, LO_BYTE(htotal)); + it61620_mipi_reg_write(it61620, RX_REG_HTOTAL_H, HI_BYTE(htotal)); + + it61620_mipi_reg_write(it61620, RX_REG_VFP_L, LO_BYTE(vfp)); + it61620_mipi_reg_write(it61620, RX_REG_VFP_H, HI_BYTE(vfp)); + + it61620_mipi_reg_write(it61620, RX_REG_VSW_L, LO_BYTE(vsw)); + it61620_mipi_reg_write(it61620, RX_REG_VSW_H, HI_BYTE(vsw)); + + it61620_mipi_reg_write(it61620, RX_REG_VBP_L, LO_BYTE(vbp)); + it61620_mipi_reg_write(it61620, RX_REG_VBP_H, HI_BYTE(vbp)); + + it61620_mipi_reg_write(it61620, RX_REG_VDEW_L, LO_BYTE(vdew)); + it61620_mipi_reg_write(it61620, RX_REG_VDEW_H, HI_BYTE(vdew)); + + it61620_mipi_reg_set(it61620, RX_REG_POL, 0x03, ((!vpol_high) << 1) | + (!hpol_high)); + + if (it61620->dev_ver == DEV_VERSION_A0 && + ((hdew == 2560 && vdew == 1440 && clock == 241500) || + (hdew == 720 && vdew == 400 && clock == 28320) || + (hdew == 720 && vdew == 576 && clock == 27000))) { + dev_dbg(it61620->dev, "device A0 %dx%d %d Khz", + hdew, vdew, clock); + it61620_mipi_reg_set(it61620, RX_REG_MPPCLKI, 0x80, 0x80); + it61620_hdmi_reg_set(it61620, TX_REG_VH_TIME, 0x48, 0x48); + + it61620_hdmi_reg_write(it61620, TX_REG_PG_HFP_L, LO_BYTE(hfp)); + it61620_hdmi_reg_write(it61620, TX_REG_PG_HFP_H, HI_BYTE(hfp)); + + it61620_hdmi_reg_write(it61620, TX_REG_PG_HSW_L, LO_BYTE(hsw)); + it61620_hdmi_reg_write(it61620, TX_REG_PG_HSW_H, HI_BYTE(hsw)); + + it61620_hdmi_reg_write(it61620, TX_REG_PG_HBP_L, LO_BYTE(hbp)); + it61620_hdmi_reg_write(it61620, TX_REG_PG_HBP_H, HI_BYTE(hbp)); + + it61620_hdmi_reg_write(it61620, TX_REG_PG_DEW_L, LO_BYTE(hdew)); + it61620_hdmi_reg_write(it61620, TX_REG_PG_DEW_H, HI_BYTE(hdew)); + + it61620_hdmi_reg_write(it61620, TX_REG_PG_HVR2_L, 0xFF); + it61620_hdmi_reg_write(it61620, TX_REG_PG_HVR2_H, 0x0F); + + it61620_hdmi_reg_write(it61620, TX_REG_PG_VFP_L, LO_BYTE(vfp)); + it61620_hdmi_reg_write(it61620, TX_REG_PG_VFP_H, HI_BYTE(vfp)); + + it61620_hdmi_reg_write(it61620, TX_REG_PG_VSW_L, LO_BYTE(vsw)); + it61620_hdmi_reg_write(it61620, TX_REG_PG_VSW_H, HI_BYTE(vsw)); + + it61620_hdmi_reg_write(it61620, TX_REG_PG_VBP_L, LO_BYTE(vbp)); + it61620_hdmi_reg_write(it61620, TX_REG_PG_VBP_H, HI_BYTE(vbp)); + + it61620_hdmi_reg_write(it61620, TX_REG_PG_VDEW_L, LO_BYTE(vdew)); + it61620_hdmi_reg_write(it61620, TX_REG_PG_HDEW_H, HI_BYTE(vdew)); + + it61620_hdmi_reg_write(it61620, TX_REG_PG_VFP2_L, 0xFF); + it61620_hdmi_reg_write(it61620, TX_REG_PG_VFP2_H, 0x0F); + + it61620_hdmi_reg_set(it61620, TX_REG_PG_POL, 0x07, + ((vpol_high) << 1) | (hpol_high)); + + } else { + it61620_mipi_reg_set(it61620, RX_REG_MPPCLKI, 0x80, 0x00); + it61620_hdmi_reg_set(it61620, TX_REG_VH_TIME, 0x48, 0x00); + } + + it61620_mipi_d2p_reset(it61620); +} + +static void it61620_hdmi_reset(struct it61620 *it61620) +{ + it61620_hdmi_reg_set(it61620, TX_REG_RESET_1_CTRL, 0x7E, 0x7E); + it61620_hdmi_reg_set(it61620, TX_REG_RESET_2_CTRL, 0x36, 0x36); + usleep_range(1000, 2000); + + it61620_hdmi_reg_set(it61620, TX_REG_RESET_1_CTRL, 0x1F, 0x00); + usleep_range(1000, 2000); + it61620_hdmi_reg_set(it61620, TX_REG_RESET_1_CTRL, 0x40, 0x00); + + it61620_hdmi_reg_write(it61620, TX_REG_RDROM_TRG, 0x04); + usleep_range(1000, 2000); + + it61620_hdmi_reg_set(it61620, TX_REG_SYS_CONFIG, B_EN_HDMI, B_EN_HDMI); + + /* Reset AFE */ + it61620_hdmi_reg_set(it61620, TX_REG_XLC_7_CTRL, 0x04, 0x00); + it61620_hdmi_reg_set(it61620, TX_REG_IPLL_CTRL, 0x02, 0x00); + it61620_hdmi_reg_set(it61620, TX_REG_TXPLL_CTRL, 0x04, 0x00); + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_CTRL, 0x01, 0x00); + + it61620_hdmi_reg_set(it61620, TX_REG_XLC_7_CTRL, 0x04, 0x04); + it61620_hdmi_reg_set(it61620, TX_REG_IPLL_CTRL, 0x02, 0x02); + it61620_hdmi_reg_set(it61620, TX_REG_TXPLL_CTRL, 0x04, 0x04); + + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_CTRL, 0x01, 0x01); + + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_CTRL, 0x08, 0x08); + + it61620_hdmi_reg_write(it61620, TX_REG_V_QUEUE, 0x08); + it61620_hdmi_reg_write(it61620, TX_REG_V_TU, 0x07); + + it61620_hdmi_reg_write(it61620, TX_REG_CR_1_CTRL, 0x09); + + it61620_hdmi_reg_write(it61620, TX_REG_CR_2_CTRL, 0x16); + + it61620_hdmi_reg_write(it61620, TX_REG_VD_CTRL1, 0x04); + + it61620_hdmi_reg_write(it61620, TX_REG_HDCP_CTRL2, 0x04); + + it61620_hdmi_reg_write(it61620, TX_REG_VD_CTRL3, 0x84); + it61620_hdmi_reg_write(it61620, TX_REG_HPD_CONFIG, 0x06); + usleep_range(1000, 2000); + + it61620_hdmi_reg_write(it61620, TX_REG_VD_CTRL2, 0x2E); + it61620_hdmi_reg_write(it61620, TX_REG_HDMI_CTRL1, 0x30); + + it61620_hdmi_reg_write(it61620, TX_REG_HDMI_CTRL2, 0x04); +} + +static void it61620_hdmi_poweron(struct it61620 *it61620) +{ + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_PD_CTRL, 0x70, 0x00); + + it61620_hdmi_reg_set(it61620, TX_REG_XLC_7_CTRL, 0x07, 0x06); + it61620_hdmi_reg_set(it61620, TX_REG_IPLL_CTRL, 0x12, 0x12); + it61620_hdmi_reg_set(it61620, TX_REG_TXPLL_CTRL, 0xc6, 0x84); + it61620_hdmi_reg_set(it61620, TX_REG_SSC_PD, 0x03, 0x03); + + it61620_hdmi_reg_set(it61620, TX_REG_CLOCK_PWD_CTRL, 0x0F, 0x00); + it61620_hdmi_reg_set(it61620, TX_REG_VD_CTRL2, B_VIDEO_FIFO_REST, + B_VIDEO_FIFO_REST); + usleep_range(1000, 2000); + it61620_hdmi_reg_set(it61620, TX_REG_VD_CTRL2, B_VIDEO_FIFO_REST, 0x00); +} + +static void it61620_hdmi_powerdown(struct it61620 *it61620) +{ + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_PD_CTRL, 0x70, 0x70); + + it61620_hdmi_reg_set(it61620, TX_REG_SSC_PD, 0x03, 0x00); + it61620_hdmi_reg_set(it61620, TX_REG_IPLL_CTRL, 0x12, 0x00); + it61620_hdmi_reg_set(it61620, TX_REG_TXPLL_CTRL, 0xc6, 0xc2); + it61620_hdmi_reg_set(it61620, TX_REG_XLC_7_CTRL, 0x07, 0x01); + + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_CTRL, 0xf9, 0x00); + it61620_hdmi_reg_set(it61620, TX_REG_AUX_CTRL, 0x90, 0x00); + + it61620_hdmi_reg_set(it61620, TX_REG_CLOCK_PWD_CTRL, 0x0F, 0x0a); + it61620_hdmi_reg_set(it61620, TX_REG_CEC_CONFIG, B_EN_CEC, 0x00); +} + +static bool it61620_hdmi_get_hpd_status(struct it61620 *it61620) +{ + int val; + + val = it61620_hdmi_reg_read(it61620, TX_REG_STATUS01); + if (val < 0) + return false; + + return !!(val & B_HPD_STATUS); +} + +static void it61620_hdmi_ddc_abort(struct it61620 *it61620) +{ + struct drm_device *drm = it61620->drm; + + it61620_hdmi_reg_set(it61620, TX_REG_DDC_CTRL2, B_DDC_REST, B_DDC_REST); + usleep_range(1000, 2000); + it61620_hdmi_reg_set(it61620, TX_REG_DDC_CTRL2, B_DDC_REST, 0x00); + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, DDC_COMMAND_ABORT); + usleep_range(1000, 2000); + drm_dbg(drm, "tx ddc ststus %02X\n", + it61620_hdmi_reg_read(it61620, TX_REG_DDC_STATUS)); +} + +static int it61620_hdmi_ddc_wait(struct it61620 *it61620) +{ + struct drm_device *drm = it61620->drm; + unsigned int ddc_status; + int ret = 0; + unsigned long timeout; + + timeout = jiffies + msecs_to_jiffies(SOFT_DDC_TIMEOUT_MS) + 1; + + for (;;) { + usleep_range(1000, 2000); + ddc_status = it61620_hdmi_reg_read(it61620, TX_REG_DDC_STATUS); + + if (ddc_status & B_DDC_NOACK) { + drm_dbg(drm, "DDC no ack"); + ret = -EIO; + break; + } + + if (ddc_status & B_DDC_TX_DONE) + break; + + if (ddc_status & B_DDC_FULL) { + drm_dbg(drm, "DDC FULL"); + break; + } + + if (time_after(jiffies, timeout)) { + drm_dbg(drm, "DDC SOFT timeout %x\n", ddc_status); + ret = -ETIMEDOUT; + break; + } + } + + return ret; +} + +static int it61620_hdmi_get_ddc_fifo(struct it61620 *it61620, u8 *buf, + size_t len) +{ + int err; + struct device *dev = it61620->dev; + + if (!it61620->powered) + return -ENODEV; + + err = regmap_bulk_read(it61620->tx_regmap, TX_REG_DDC_FIFO, buf, len); + if (err < 0) { + dev_err(dev, "read ddc fifo failed tx reg[0x%x] err = %d", + TX_REG_DDC_FIFO, err); + return err; + } + + return 0; +} + +static int it61620_hdmi_set_ddc_fifo(struct it61620 *it61620, u8 *buf, + size_t len) +{ + int err; + struct device *dev = it61620->dev; + + if (!it61620->powered) + return -ENODEV; + + err = regmap_bulk_write(it61620->tx_regmap, TX_REG_DDC_FIFO, buf, len); + if (err < 0) { + dev_err(dev, "write ddc fifo failed tx reg[0x%x] err = %d", + TX_REG_DDC_FIFO, err); + return err; + } + + return 0; +} + +static const struct it61620_hdmi_afe_setting hdmi_afe[4] = { + {375000, 0x01, 0x02, + {0x03, 0x53, 0x1A, 0x03, 0x00, 0x04, + 0x03, 0x53, 0x1A, 0x03, 0x00, 0x04, + 0x03, 0x53, 0x1A, 0x03, 0x00, 0x04, + 0x01, 0x4B, 0x0F, 0x00, 0x07, 0x04}}, + {340000, 0x01, 0x02, + {0x03, 0x53, 0x1A, 0x03, 0x00, 0x04, + 0x03, 0x53, 0x1A, 0x03, 0x00, 0x04, + 0x03, 0x53, 0x1A, 0x03, 0x00, 0x04, + 0x01, 0x4B, 0x0F, 0x00, 0x07, 0x04}}, + {150000, 0x00, 0x00, + {0x03, 0x43, 0x18, 0x03, 0x00, 0x04, + 0x03, 0x43, 0x18, 0x03, 0x00, 0x04, + 0x03, 0x43, 0x18, 0x03, 0x00, 0x04, + 0x03, 0x43, 0x18, 0x03, 0x00, 0x04}}, + {0, 0x00, 0x00, + {0x03, 0x43, 0x18, 0x03, 0x00, 0x04, + 0x03, 0x43, 0x18, 0x03, 0x00, 0x04, + 0x03, 0x43, 0x18, 0x03, 0x00, 0x04, + 0x03, 0x43, 0x18, 0x03, 0x00, 0x04}} +}; + +static void it61620_hdmi_setup_afe(struct it61620 *it61620, int clock) +{ + int i; + unsigned int reg_ofset; + const struct it61620_hdmi_afe_setting *afe; + + it61620_hdmi_reg_set(it61620, TX_REG_AFE30, 0x1F, 0x07); + it61620_hdmi_reg_write(it61620, TX_REG_AFEE9, 0x10); + it61620_hdmi_reg_write(it61620, TX_REG_AFE33, 0x00); + it61620_hdmi_reg_write(it61620, TX_REG_AFE34, 0xE4); + + it61620_hdmi_reg_write(it61620, TX_REG_AFE35, 0x00); + it61620_hdmi_reg_write(it61620, TX_REG_AFEE9, 0x10); + + for (i = 0; i < sizeof(hdmi_afe); i++) { + if (clock > hdmi_afe[i].clock || hdmi_afe[i].clock == 0) + break; + } + + afe = &hdmi_afe[i]; + + it61620_hdmi_reg_write(it61620, TX_REG_AFE0E, 0xF0); + + if (clock > 100000) + it61620_hdmi_reg_set(it61620, TX_REG_TXPLL_CTRL, 0x19, 0x08); + else + it61620_hdmi_reg_set(it61620, TX_REG_TXPLL_CTRL, 0x19, 0x11); + + if (afe->h2on_pll) { + it61620_hdmi_reg_write(it61620, TX_REG_AFE_XP, 0x48); + it61620_hdmi_reg_set(it61620, TX_REG_AFE_XLC1, 0x87, 0x81); + it61620_hdmi_reg_set(it61620, TX_REG_AFE_XLC2, 0x40, 0x00); + it61620_hdmi_reg_write(it61620, TX_REG_AFE_XLC3, 0x32); + it61620_hdmi_reg_set(it61620, TX_REG_XLC_7_CTRL, 0xFF, 0xB6); + } else { + it61620_hdmi_reg_write(it61620, TX_REG_AFE_XP, 0x00); + } + + it61620_hdmi_reg_write(it61620, TX_REG_AFE_DRV, 0x00); + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_CTRL, 0x02, afe->hs); + + for (i = 0, reg_ofset = 0x280; reg_ofset <= 0x297; reg_ofset++) + it61620_hdmi_reg_write(it61620, reg_ofset, afe->afe_val[i++]); + + it61620_hdmi_reg_set(it61620, TX_REG_INT_MASK3, B_TMDS_STB_CHG, + B_TMDS_STB_CHG); +} + +static inline void it61620_hdmi_fire_afe(struct it61620 *it61620) +{ + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_CTRL, 0xF1, 0xF1); +} + +static inline void it61620_hdmi_disable_afe(struct it61620 *it61620) +{ + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_CTRL, 0xF1, 0x00); +} + +static int it61620_hdmi_hdcprd(struct it61620 *it61620, int offset, int bytenum) +{ + int ret = 0; + + guard(mutex)(&it61620->ddc_lock); + + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, + DDC_COMMAND_FIFO_CLR); + usleep_range(1000, 2000); + it61620_hdmi_reg_write(it61620, TX_REG_DDC_ADDR, DDC_HDCP_ADDR); + it61620_hdmi_reg_write(it61620, TX_REG_DDC_OFFSET, offset); + it61620_hdmi_reg_write(it61620, TX_REG_DDC_NUM_L, bytenum); + it61620_hdmi_reg_write(it61620, TX_REG_DDC_NUM_H, (bytenum & 0x300) >> 8); + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, DDC_COMMAND_BURST_R); + + if (it61620_hdmi_ddc_wait(it61620) < 0) { + it61620_hdmi_ddc_abort(it61620); + ret = -EIO; + dev_dbg(it61620->dev, "ddc fail"); + } + return ret; +} + +static int it61620_hdmi_hdcp_ksvlist_rd(struct it61620 *it61620, + unsigned int bytenum, u8 *out) +{ + int ret = 0; + unsigned int i; + unsigned int count; + + guard(mutex)(&it61620->ddc_lock); + + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, DDC_COMMAND_FIFO_CLR); + usleep_range(1000, 2000); + it61620_hdmi_reg_write(it61620, TX_REG_DDC_ADDR, DDC_HDCP_ADDR); + it61620_hdmi_reg_write(it61620, TX_REG_DDC_OFFSET, 0x43); + it61620_hdmi_reg_write(it61620, TX_REG_DDC_NUM_L, bytenum); + it61620_hdmi_reg_write(it61620, TX_REG_DDC_NUM_H, (bytenum & 0x300) >> 8); + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, DDC_COMMAND_BURST_R); + + for (i = 0; i < bytenum;) { + if (it61620_hdmi_ddc_wait(it61620) < 0) { + it61620_hdmi_ddc_abort(it61620); + ret = -EIO; + dev_dbg(it61620->dev, "ddc fail"); + break; + } + + count = it61620_hdmi_reg_read(it61620, TX_REG_DDC_FIFO_STS) & + M_DDC_STAGE_NUM; + it61620_hdmi_get_ddc_fifo(it61620, (out + i), count); + i += count; + } + + return ret; +} + +static int it61620_hdmi_enable_hdcp(struct it61620 *it61620) +{ + struct drm_device *drm = it61620->drm; + unsigned int sts, auth_cs; + + sts = it61620_hdmi_reg_read(it61620, TX_REG_V_STS); + if ((sts & B_TMDS_STABLE) != B_TMDS_STABLE) { + drm_dbg(drm, "TMDS not stable, stop hdcp %x", sts); + return false; + } + + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL3, B_ENC_DIS, B_ENC_DIS); + usleep_range(1000, 2000); + + it61620_hdmi_reg_set(it61620, TX_REG_RESET_2_CTRL, 0x10, 0x10); + usleep_range(1000, 2000); + it61620_hdmi_reg_set(it61620, TX_REG_RESET_2_CTRL, 0x10, 0x00); + + it61620_hdmi_reg_set(it61620, TX_REG_R0TM, 0xC0, 0x40); + it61620_hdmi_reg_write(it61620, TX_REG_SHA_SEL, 0x00); + + it61620_hdmi_reg_write(it61620, TX_REG_AUTOMUTE, 0x00); + + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL2, B_AN_SEL, B_AN_SEL); + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL2, B_EN_AN_GEN, + B_EN_AN_GEN); + usleep_range(1000, 2000); + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL2, B_EN_AN_GEN, 0x00); + + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL1, B_CPDESIRED, + B_CPDESIRED); + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL3, (B_PAUSE | B_ENC_DIS), + 0x00); + + it61620_hdmi_reg_write(it61620, TX_REG_HDCP_PRO, B_AUTH_FIRE); + + /* + * HDCP start requires 100ms for the first part of the authentication + * protocol,20ms is used to wait for 61620 HW completion. + */ + if (wait_event_timeout(it61620->wq, !it61620->hpd, msecs_to_jiffies(120))) + return false; + + auth_cs = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_AUTH_CS) & M_AUTH_CH; + if (auth_cs == CS_KSVLIST_CHK) { + it61620_hdmi_hdcp_wait_ksv_list(it61620); + usleep_range(1000, 2000); + auth_cs = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_AUTH_CS) & + M_AUTH_CH; + } + + if (auth_cs == CS_AUTH_DONE) { + it61620_hdmi_enable_avmute(it61620, false); + it61620_hdmi_reg_set(it61620, TX_REG_INT1, B_INT_AUTH_F, + B_INT_AUTH_F); + it61620_hdmi_reg_set(it61620, TX_REG_INT_MASK1, B_INT_AUTH_F, + B_INT_AUTH_F); + drm_dbg(drm, "auth done"); + return true; + } + + drm_dbg(drm, "auth fail"); + it61620_hdmi_enable_avmute(it61620, true); + return false; +} + +static void it61620_hdmi_reset_hdcp(struct it61620 *it61620) +{ + it61620_hdmi_reg_set(it61620, TX_REG_INT_MASK1, + (B_INT_AUTH_D | B_INT_AUTH_F), 0x00); + it61620_hdmi_reg_set(it61620, TX_REG_INT_MASK2, B_KSV_CHECK, 0x00); + + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL3, B_ENC_DIS, B_ENC_DIS); + usleep_range(1000, 2000); + + it61620_hdmi_reg_set(it61620, TX_REG_RESET_2_CTRL, 0x18, 0x18); + usleep_range(1000, 2000); + it61620_hdmi_reg_set(it61620, TX_REG_RESET_2_CTRL, 0x18, 0x00); + + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL1, B_CPDESIRED, + B_CPDESIRED); + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL3, + (B_PAUSE | B_ENC_DIS), B_PAUSE); + it61620_hdmi_reg_write(it61620, TX_REG_AUTOMUTE, 0x00); +} + +static bool it61620_hdmi_hdcp_is_ksv_valid(u8 *ksv) +{ + int i, ones = 0; + + if ((ksv[4] == 0x93 && ksv[3] == 0x43 && ksv[2] == 0x5C && + ksv[1] == 0xDE && ksv[0] == 0x23) || + (ksv[4] == 0x7D && ksv[3] == 0xB4 && ksv[2] == 0x21 && + ksv[1] == 0x37 && ksv[0] == 0x0B)) + return false; + + /* KSV has 20 1's and 20 0's */ + for (i = 0; i < 5; i++) + ones += hweight8(ksv[i]); + + return ones == 20; +} + +static void it61620_hdmi_disable_hdcp(struct it61620 *it61620) +{ + it61620_hdmi_reset_hdcp(it61620); +} + +static int it61620_hdmi_start_hdcp(struct it61620 *it61620) +{ + struct drm_device *drm = it61620->drm; + u8 rx_hdmi_mode; + u8 bksv[DRM_HDCP_KSV_LEN]; + bool retcheck; + + if (it61620_hdmi_hdcprd(it61620, DRM_HDCP_DDC_BSTATUS, + DRM_HDCP_BSTATUS_LEN) < 0) { + drm_dbg(drm, "read bstatus fail!\n"); + return false; + } + + rx_hdmi_mode = (it61620_hdmi_reg_read(it61620, 0x7E) & 0x10) >> 4; + if (it61620->is_hdmi != rx_hdmi_mode) + return false; + + it61620_hdmi_hdcprd(it61620, DRM_HDCP_DDC_BKSV, DRM_HDCP_KSV_LEN); + bksv[0] = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_BKSV1); + bksv[1] = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_BKSV2); + bksv[2] = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_BKSV3); + bksv[3] = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_BKSV4); + bksv[4] = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_BKSV5); + retcheck = it61620_hdmi_hdcp_is_ksv_valid(bksv); + if (!retcheck) { + drm_dbg(drm, "ksv valid!\n"); + return false; + } + + if (drm_hdcp_check_ksvs_revoked(drm, bksv, 1) > 0) + return false; + + return it61620_hdmi_enable_hdcp(it61620); +} + +static int it61620_hdmi_sha1_digest(struct it61620 *it61620, u8 *sha1_input, + unsigned int size, u8 *output_av) +{ + struct shash_desc *desc; + struct crypto_shash *tfm; + int err; + struct drm_device *drm = it61620->drm; + + tfm = crypto_alloc_shash("sha1", 0, 0); + if (IS_ERR(tfm)) { + drm_dbg(drm, "crypto_alloc_shash sha1 failed"); + return PTR_ERR(tfm); + } + desc = kzalloc(sizeof(*desc) + crypto_shash_descsize(tfm), GFP_KERNEL); + if (!desc) { + crypto_free_shash(tfm); + return -ENOMEM; + } + + desc->tfm = tfm; + err = crypto_shash_digest(desc, sha1_input, size, output_av); + if (err) + drm_dbg(drm, "crypto_shash_digest sha1 failed"); + + crypto_free_shash(tfm); + kfree(desc); + return err; +} + +static int it61620_hdmi_setup_sha1_input(struct it61620 *it61620, u8 *input) +{ + struct drm_device *drm = it61620->drm; + u8 bstatus[2]; + int down_stream_count, i, count = 0; + + it61620_hdmi_hdcprd(it61620, DRM_HDCP_DDC_BSTATUS, DRM_HDCP_BSTATUS_LEN); + bstatus[0] = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_BSTS_L); + bstatus[1] = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_BSTS_H); + + down_stream_count = DRM_HDCP_NUM_DOWNSTREAM(bstatus[0]); + if (DRM_HDCP_MAX_DEVICE_EXCEEDED(bstatus[0]) || + DRM_HDCP_MAX_CASCADE_EXCEEDED(bstatus[1])) { + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL3, + (B_PAUSE | B_ENC_DIS), B_PAUSE); + return 0; + } + + if (!down_stream_count || + down_stream_count > MAX_HDCP_DOWN_STREAM_COUNT) { + drm_dbg(drm, "HDCP down stream count Error %d", + down_stream_count); + return 0; + } + drm_dbg(drm, "down stream count %d\n", down_stream_count); + + count = down_stream_count * DRM_HDCP_KSV_LEN; + it61620_hdmi_hdcp_ksvlist_rd(it61620, count, input); + if (drm_hdcp_check_ksvs_revoked(drm, input, down_stream_count) > 0) + return 0; + + input[count++] = bstatus[0]; + input[count++] = bstatus[1]; + + it61620_hdmi_reg_set(it61620, TX_REG_SHA_SEL, 0x70, 0x70); + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL2, B_EN_M0_RD, B_EN_M0_RD); + for (i = 0; i < 8; i++) + input[count++] = it61620_hdmi_reg_read(it61620, + (TX_REG_ANM0V1 + i)); + + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL2, B_EN_M0_RD, 0x00); + + return count; +} + +static bool it61620_hdmi_hdcp_part2_ksvlist_check(struct it61620 *it61620) +{ + struct drm_device *drm = it61620->drm; + u8 av[5][4], bv[5][4]; + int i, j; + + i = it61620_hdmi_setup_sha1_input(it61620, it61620->sha1_input); + if (i <= 0) + return false; + + it61620_hdmi_sha1_digest(it61620, it61620->sha1_input, i, (u8 *)av); + + for (i = 0; i < DRM_HDCP_V_PRIME_NUM_PARTS; i++) { + it61620_hdmi_hdcprd(it61620, DRM_HDCP_DDC_V_PRIME(i), + DRM_HDCP_V_PRIME_PART_LEN); + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL2, + B_EN_M0_RD, B_EN_M0_RD); + it61620_hdmi_reg_set(it61620, TX_REG_SHA_SEL, 0x70, (i << 4)); + + for (j = 0; j < DRM_HDCP_V_PRIME_PART_LEN; j++) + bv[i][j] = it61620_hdmi_reg_read(it61620, + TX_REG_ANM0V1 + j); + } + + for (i = 0; i < DRM_HDCP_V_PRIME_NUM_PARTS; i++) + if (bv[i][3] != av[i][0] || bv[i][2] != av[i][1] || + bv[i][1] != av[i][2] || bv[i][0] != av[i][3]) + break; + + if (i == DRM_HDCP_V_PRIME_NUM_PARTS) + return true; + + drm_dbg(drm, "V' Not match!!"); + return false; +} + +static void it61620_hdmi_hdcp_wait_ksv_list(struct it61620 *it61620) +{ + u8 bcaps = 0; + unsigned long timeout; + + timeout = jiffies + msecs_to_jiffies(5000) + 1; + for (;;) { + usleep_range(1000, 2000); + it61620_hdmi_hdcprd(it61620, DRM_HDCP_DDC_BCAPS, 1); + bcaps = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_BCAPS); + if (bcaps & B_KSV_READY) + break; + + if (it61620->hdcp_state != CP_GOING) + break; + + if (time_after(jiffies, timeout)) + break; + } + + if ((bcaps & B_KSV_READY) && + it61620_hdmi_hdcp_part2_ksvlist_check(it61620)) { + it61620_hdmi_reg_write(it61620, TX_REG_HDCP_PRO, + B_LIST_CHK_DONE); + return; + } + it61620_hdmi_reg_write(it61620, TX_REG_HDCP_PRO, + B_LIST_CHK_DONE | B_LIST_CHK_FAIL); +} + +static void it61620_remove_edid(struct it61620 *it61620) +{ + drm_edid_free(it61620->cached_edid); + it61620->cached_edid = NULL; +} + +static void it61620_hdmi_irq_hdcp_auth_fail(struct it61620 *it61620) +{ + struct drm_device *drm = it61620->drm; + + if (it61620->hdcp_state == CP_GOING) { + it61620_hdmi_enable_avmute(it61620, true); + drm_dbg(drm, "auth fail after done, set avmute"); + it61620_start_hdcp_work(it61620); + } +} + +static void it61620_hdmi_irq_hpd(struct it61620 *it61620) +{ + it61620->hpd = it61620_hdmi_get_hpd_status(it61620); + + if (!it61620->hpd) { + wake_up(&it61620->wq); + it61620_stop_hdcp_work(it61620); + it61620_hdmi_disable_afe(it61620); + it61620_remove_edid(it61620); + } else if (it61620->video_state == it61620_VIDEO_ON) { + it61620_hdmi_fire_afe(it61620); + it61620_start_hdcp_work(it61620); + } +} + +static void it61620_hdmi_irq_rxsen_chg(struct it61620 *it61620) +{ + unsigned int rxsen; + + if (!it61620_hdmi_get_hpd_status(it61620)) + return; + + rxsen = it61620_hdmi_reg_read(it61620, TX_REG_V_STS) & B_RXSEN; + if (it61620->video_state == it61620_VIDEO_ON) { + if (rxsen) { + it61620_hdmi_fire_afe(it61620); + it61620_start_hdcp_work(it61620); + } else { + it61620_stop_hdcp_work(it61620); + it61620_hdmi_disable_afe(it61620); + } + } +} + +static void it61620_hdmi_irq_TMDS_stb_change(struct it61620 *it61620) +{ + unsigned int video_status; + + video_status = it61620_hdmi_reg_read(it61620, TX_REG_V_STS); + + if (video_status & B_TMDS_STABLE) + it61620_start_hdcp_work(it61620); +} + +static bool it61620_test_bit(unsigned int bit, const unsigned int *addr) +{ + return 1 & (addr[bit / BITS_PER_BYTE] >> (bit % BITS_PER_BYTE)); +} + +static void it61620_hdmi_interrupt_handler(struct it61620 *it61620) +{ + unsigned int int_status[3], i; + static const struct { + int bit; + void (*handler)(struct it61620 *it61620); + } irq_vec[] = { + { BIT_HPD_CHG, it61620_hdmi_irq_hpd }, + { BIT_RXSEN_CHANGE, it61620_hdmi_irq_rxsen_chg }, + { BIT_INT_AUTH_F, it61620_hdmi_irq_hdcp_auth_fail }, + { BIT_TMDS_STB_CHG, it61620_hdmi_irq_TMDS_stb_change }, + }; + + int_status[0] = it61620_hdmi_reg_read(it61620, TX_REG_INT1); + int_status[1] = it61620_hdmi_reg_read(it61620, TX_REG_INT2); + int_status[2] = it61620_hdmi_reg_read(it61620, TX_REG_INT3); + + it61620_hdmi_reg_write(it61620, TX_REG_INT1, int_status[0]); + it61620_hdmi_reg_write(it61620, TX_REG_INT2, int_status[1]); + it61620_hdmi_reg_write(it61620, TX_REG_INT3, int_status[2]); + + for (i = 0; i < ARRAY_SIZE(irq_vec); i++) { + if (it61620_test_bit(irq_vec[i].bit, (unsigned int *)int_status)) + irq_vec[i].handler(it61620); + } +} + +static void it61620_hdmi_irq(struct it61620 *it61620) +{ + unsigned int reg_val; + + reg_val = it61620_hdmi_reg_read(it61620, TX_REG_HDMITX_BANK); + if (reg_val & B_INT_EVENT_HDMI) + it61620_hdmi_interrupt_handler(it61620); +} + +static void it61620_hdmi_audio_set_ncts(struct it61620 *it61620, + unsigned int sample_rate) +{ + unsigned int n, cts; + + drm_hdmi_acr_get_n_cts(it61620->vm.pixelclock, sample_rate, &n, &cts); + + it61620_hdmi_reg_write(it61620, TX_REG_AUDPKT_N_0, (u8)((n) & 0xFF)); + it61620_hdmi_reg_write(it61620, TX_REG_AUDPKT_N_1, + (u8)((n >> 8) & 0xFF)); + it61620_hdmi_reg_write(it61620, TX_REG_AUDPKT_N_2, + (u8)((n >> 16) & 0x0F)); + + it61620_hdmi_reg_write(it61620, TX_REG_AUDPKT_CTS_0, (u8)((cts) & 0xFF)); + it61620_hdmi_reg_write(it61620, TX_REG_AUDPKT_CTS_1, + (u8)((cts >> 8) & 0xFF)); + it61620_hdmi_reg_write(it61620, TX_REG_AUDPKT_CTS_2, + (u8)((cts >> 16) & 0x0F)); +} + +static inline void it61620_hdmi_disable_audio_infoframe(struct it61620 *it61620) +{ + it61620_hdmi_reg_set(it61620, TX_REG_EN_PKT1, + (B_EN_AUD | B_EN_AUD_RP), 0x00); +} + +static inline void it61620_hdmi_enable_audio_infoframe(struct it61620 *it61620) +{ + it61620_hdmi_reg_set(it61620, TX_REG_EN_PKT1, (B_EN_AUD | B_EN_AUD_RP), + (B_EN_AUD | B_EN_AUD_RP)); +} + +static inline void it61620_hdmi_disable_avi_infoframe(struct it61620 *it61620) +{ + it61620_hdmi_reg_set(it61620, TX_REG_EN_PKT1, + (B_EN_AVI | B_AVI_RP), 0x00); +} + +static inline void it61620_hdmi_enable_avi_infoframe(struct it61620 *it61620) +{ + it61620_hdmi_reg_set(it61620, TX_REG_EN_PKT1, (B_EN_AVI | B_AVI_RP), + (B_EN_AVI | B_AVI_RP)); +} + +static inline void it61620_hdmi_enable_hdmi_mode(struct it61620 *it61620) +{ + it61620_hdmi_reg_set(it61620, TX_REG_HDMI_CTRL1, B_EN_HDMI_MODE, + B_EN_HDMI_MODE); +} + +static inline void it61620_hdmi_enable_DVI_mode(struct it61620 *it61620) +{ + it61620_hdmi_reg_set(it61620, TX_REG_HDMI_CTRL1, B_EN_HDMI_MODE, 0x00); +} + +static inline void it61620_hdmi_enable_avmute(struct it61620 *it61620, + bool enable) +{ + it61620_hdmi_reg_set(it61620, TX_REG_HDMI_CTRL2, B_EN_AVMUTE, enable); +} + +static void it61620_hdmi_avi_infoframe_set(struct it61620 *it61620, + const u8 *buffer, size_t len) +{ + struct drm_device *drm = it61620->drm; + const u8 *ptr; + u8 i; + + drm_dbg(drm, "avinfo set\n"); + it61620_hdmi_disable_avi_infoframe(it61620); + + it61620_hdmi_enable_hdmi_mode(it61620); + /* fill PB */ + ptr = buffer + HDMI_INFOFRAME_HEADER_SIZE; + for (i = 0; i < len - HDMI_INFOFRAME_HEADER_SIZE; i++) + it61620_hdmi_reg_write(it61620, TX_REG_AVIINFO_DB01 + i, ptr[i]); + + it61620_hdmi_reg_write(it61620, TX_REG_AVIINFO_DB14, buffer[3]); + + /* Enable */ + it61620_hdmi_enable_avi_infoframe(it61620); +} + +static void it61620_hdmi_config_output(struct it61620 *it61620) +{ + struct drm_device *drm = it61620->drm; + + it61620_hdmi_reset(it61620); + it61620_hdmi_poweron(it61620); + it61620_hdmi_reg_set(it61620, TX_REG_HDMI_CTRL2, 0x70, 0x00); + if (it61620->is_hdmi) { + drm_dbg(drm, "HDMI\n"); + it61620_hdmi_enable_hdmi_mode(it61620); + it61620_hdmi_reg_set(it61620, TX_REG_EN_PKT2, + (B_EN_GEN | B_GEN_RP), + (B_EN_GEN | B_GEN_RP)); + } else { + drm_dbg(drm, "DVI\n"); + it61620_hdmi_enable_DVI_mode(it61620); + it61620_hdmi_reg_write(it61620, TX_REG_EN_PKT2, 0x00); + it61620_hdmi_reg_write(it61620, TX_REG_EN_PKT1, 0x00); + } + + it61620_hdmi_enable_avmute(it61620, false); + it61620_hdmi_setup_afe(it61620, it61620->vm.pixelclock / 1000); + it61620_hdmi_fire_afe(it61620); + it61620->video_state = it61620_VIDEO_ON; +} + +static int it61620_hdmi_audio_infoframe_set(struct it61620 *it61620, + const u8 *buffer, size_t len) +{ + u8 i; + const u8 *ptr; + + it61620_hdmi_disable_audio_infoframe(it61620); + + /* fill PB */ + ptr = buffer + HDMI_INFOFRAME_HEADER_SIZE; + for (i = 0; i < len - HDMI_INFOFRAME_HEADER_SIZE; i++) + it61620_hdmi_reg_write(it61620, TX_REG_AUDINFO_DB01 + i, ptr[i]); + + it61620_hdmi_reg_write(it61620, TX_REG_AUDINFO_DB06, buffer[3]); + it61620_hdmi_reg_write(it61620, TX_REG_AUDINFO_DB07, 0x00); + it61620_hdmi_reg_write(it61620, TX_REG_AUDINFO_DB08, 0x00); + it61620_hdmi_reg_write(it61620, TX_REG_AUDINFO_DB09, 0x00); + it61620_hdmi_reg_write(it61620, TX_REG_AUDINFO_DB10, 0x00); + + /* Enable */ + it61620_hdmi_enable_audio_infoframe(it61620); + return 0; +} + +static void it61620_start_hdcp_work(struct it61620 *it61620) +{ + it61620->hdcp_state = CP_GOING; + queue_delayed_work(system_wq, &it61620->hdcp_work, + msecs_to_jiffies(2400)); +} + +static void it61620_stop_hdcp_work(struct it61620 *it61620) +{ + it61620->hdcp_state = CP_NONE; + cancel_delayed_work_sync(&it61620->hdcp_work); + it61620_hdmi_disable_hdcp(it61620); +} + +static void it61620_hw_reset(struct it61620 *it61620) +{ + struct it61620_platform_data *pdata = &it61620->pdata; + + if (!pdata->gpiod_reset) + return; + + gpiod_set_value_cansleep(pdata->gpiod_reset, 1); + + usleep_range(10000, 20000); + gpiod_set_value_cansleep(pdata->gpiod_reset, 0); + usleep_range(10000, 20000); +} + +static int it61620_enable_devices(struct it61620 *it61620) +{ + struct device *dev = &it61620->it61620_i2c->dev; + unsigned int device_id[5]; + unsigned int i, vid, pid; + + regmap_write(it61620->it61620_regmap, REG_CTRL_PW, 0x55); + regmap_write(it61620->it61620_regmap, REG_CTRL_PW, 0xAA); + regmap_write(it61620->it61620_regmap, REG_CTRL_PW, 0xC3); + regmap_write(it61620->it61620_regmap, REG_CTRL_PW, 0xA5); + usleep_range(1000, 2000); + + for (i = 0; i < 5; i++) + device_id[i] = it61620_mipi_reg_read(it61620, + REG_VENDER_ID_L + i); + + dev_dbg(dev, "IT61620 ver %02X", device_id[4]); + + vid = (device_id[1] << 8) | device_id[0]; + pid = (device_id[3] << 8) | device_id[2]; + + if (vid != it61620->chip_info->vid || + pid != it61620->chip_info->pid) { + dev_err(dev, "vid %X != %X", + vid, it61620->chip_info->vid); + dev_err(dev, "pid %X != %X", + pid, it61620->chip_info->pid); + + return -ENODEV; + } + + it61620->dev_ver = device_id[4]; + return 0; +} + +static void it61620_int_setup(struct it61620 *it61620) +{ + /* SET INT# to Active Low open-drain */ + it61620_mipi_reg_set(it61620, RX_REG_INT_POL, 0x08, 0x08); + it61620_hdmi_reg_set(it61620, TX_REG_SYS_CONFIG, 0x0F, B_INT_MODE); + it61620_hdmi_reg_set(it61620, REG_TX_INT_CTRL, B_DIS_INT_OUTPUT, 0x00); +} + +static void it61620_int_enable(struct it61620 *it61620) +{ + it61620_hdmi_reg_set(it61620, TX_REG_INT_MASK1, B_HPD_CHG, B_HPD_CHG); +} + +static int it61620_reset_init(struct it61620 *it61620) +{ + it61620_hw_reset(it61620); + + if (it61620_enable_devices(it61620) < 0) + return -ENODEV; + + it61620_mipi_reset(it61620); + it61620_hdmi_reset(it61620); + it61620_int_setup(it61620); + it61620_int_enable(it61620); + it61620_hdmi_powerdown(it61620); + + return 0; +} + +static int it61620_poweron(struct it61620 *it61620) +{ + struct it61620_platform_data *pdata = &it61620->pdata; + struct drm_device *drm = it61620->drm; + struct device *dev = it61620->dev; + int err; + + if (it61620->powered) { + drm_dbg(drm, "Already powered on"); + return 0; + } + + err = regulator_enable(pdata->ivdd); + if (err) { + dev_err(dev, "Failed to enable IVDD: %d", err); + goto poweron_exit; + } + + err = regulator_enable(pdata->ovdd1833); + if (err) { + dev_err(dev, "Failed to enable OVDD1833: %d", err); + goto disable_ivdd; + } + + err = regulator_enable(pdata->ovdd33); + if (err) { + dev_err(dev, "Failed to enable OVDD33: %d", err); + goto disable_ovdd1833; + } + + gpiod_set_value_cansleep(pdata->gpiod_reset, 1); + usleep_range(10000, 20000); + gpiod_set_value_cansleep(pdata->gpiod_reset, 0); + usleep_range(10000, 20000); + + err = it61620_reset_init(it61620); + if (err < 0) + goto disable_ovdd33; + + it61620->powered = true; + it61620->hpd = it61620_hdmi_get_hpd_status(it61620); + if (it61620->it61620_i2c->irq) { + enable_irq(it61620->it61620_i2c->irq); + drm_dbg(drm, "enable irq %d\n", + it61620->it61620_i2c->irq); + } + drm_dbg(drm, "it61620 poweron end\n"); + return 0; + +disable_ovdd33: + regulator_disable(pdata->ovdd33); +disable_ovdd1833: + regulator_disable(pdata->ovdd1833); +disable_ivdd: + regulator_disable(pdata->ivdd); +poweron_exit: + return err; +} + +static int it61620_poweroff(struct it61620 *it61620) +{ + struct it61620_platform_data *pdata = &it61620->pdata; + struct drm_device *drm = it61620->drm; + struct device *dev = it61620->dev; + int err; + + if (!it61620->powered) { + drm_dbg(drm, "Already powered off"); + return 0; + } + + if (it61620->it61620_i2c->irq) { + disable_irq(it61620->it61620_i2c->irq); + drm_dbg(drm, "disable irq %d\n", + it61620->it61620_i2c->irq); + } + + gpiod_set_value_cansleep(pdata->gpiod_reset, 1); + + err = regulator_disable(pdata->ovdd33); + if (err) + dev_err(dev, "Failed to disable ovdd33: %d", err); + + err = regulator_disable(pdata->ivdd); + if (err) + dev_err(dev, "Failed to disable IVDD: %d", err); + + usleep_range(2000, 3000); + + err = regulator_disable(pdata->ovdd1833); + if (err) + dev_err(dev, "Failed to disable ovdd1833: %d", err); + + it61620->powered = false; + it61620->hpd = false; + it61620->connector_status = connector_status_disconnected; + it61620_remove_edid(it61620); + drm_dbg(drm, "it61620 poweroff\n"); + + return 0; +} + +static void it61620_config_default(struct it61620 *it61620) +{ + struct it61620_mipirx *mipirx = &it61620->mipirx_config; + struct it61620_audio *audio_config = &it61620->audio_config; + + mipirx->lane_num = 4; + mipirx->pn_swap = 0; + mipirx->lane_swap = 0; + it61620->connector_status = connector_status_disconnected; + + audio_config->select = I2S; + audio_config->sample_rate = SAMPLE_RATE_48K; + audio_config->type = LPCM; + audio_config->word_length = WORD_LENGTH_16BIT; + audio_config->channel_count = 2; + audio_config->audfmt = 0; +} + +static void it61620_show_drm_video_mode(struct it61620 *it61620, + const struct videomode *vm) +{ + struct drm_device *drm = it61620->drm; + + drm_dbg(drm, "HActive = %u\n", vm->hactive); + drm_dbg(drm, "VActive = %u\n", vm->vactive); + drm_dbg(drm, "HTotal = %u\n", + vm->hactive + vm->hfront_porch + vm->hsync_len + + vm->hback_porch); + drm_dbg(drm, "VTotal = %u\n", + vm->vactive + vm->vfront_porch + vm->vsync_len + + vm->vback_porch); + drm_dbg(drm, "PCLK = %lukhz\n", vm->pixelclock / 1000); + drm_dbg(drm, "HFP = %u\n", vm->hfront_porch); + drm_dbg(drm, "HSW = %u\n", vm->hsync_len); + drm_dbg(drm, "HBP = %u\n", vm->hback_porch); + drm_dbg(drm, "VFP = %u\n", vm->vfront_porch); + drm_dbg(drm, "VSW = %u\n", vm->vsync_len); + drm_dbg(drm, "VBP = %u\n", vm->vback_porch); + if (vm->flags & DISPLAY_FLAGS_HSYNC_HIGH) + drm_dbg(drm, "HPOL +\n"); + else + drm_dbg(drm, "HPOL -\n"); + + if (vm->flags & DISPLAY_FLAGS_VSYNC_HIGH) + drm_dbg(drm, "VPOL +\n"); + else + drm_dbg(drm, "VPOL -\n"); + + if (vm->flags & DISPLAY_FLAGS_INTERLACED) + drm_dbg(drm, "Intelaced\n"); + else + drm_dbg(drm, "Progressive\n"); +} + +static enum drm_mode_status it61620_mode_valid(struct it61620 *it61620, + const struct drm_display_mode *mode) +{ + if (mode->clock > 300000) + return MODE_CLOCK_HIGH; + + return MODE_OK; +} + +static int it61620_get_edid_block(void *data, u8 *buf, unsigned int block, + size_t len) +{ + struct it61620 *it61620 = data; + unsigned int edid_offset; + unsigned int cnt; + unsigned int i; + int ret = 0; + + if (len > EDID_LENGTH) + return -EINVAL; + + guard(mutex)(&it61620->ddc_lock); + + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, DDC_COMMAND_FIFO_CLR); + + it61620_hdmi_reg_write(it61620, TX_REG_DDC_ADDR, DDC_EDID_ADDR); + it61620_hdmi_reg_write(it61620, TX_REG_DDC_SEGMENT, block / 2); + + cnt = 0; + edid_offset = block * 128; + + for (i = 0; i < EDID_LENGTH; i += EDID_R_BURST_NUM, + edid_offset += EDID_R_BURST_NUM, + cnt += EDID_R_BURST_NUM) { + it61620_hdmi_reg_write(it61620, TX_REG_DDC_OFFSET, edid_offset); + it61620_hdmi_reg_write(it61620, TX_REG_DDC_SEGMENT, block >> 1); + it61620_hdmi_reg_write(it61620, TX_REG_DDC_NUM_L, + EDID_R_BURST_NUM); + it61620_hdmi_reg_write(it61620, TX_REG_DDC_NUM_H, + (EDID_R_BURST_NUM >> 8)); + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, + DDC_COMMAND_EDID_RD); + + if (it61620_hdmi_ddc_wait(it61620) < 0) { + it61620_hdmi_ddc_abort(it61620); + ret = -EIO; + break; + } + + it61620_hdmi_get_ddc_fifo(it61620, &buf[cnt], EDID_R_BURST_NUM); + } + + return ret; +} + +static void it61620_set_capability_from_edid_parse(struct it61620 *it61620, + const struct edid *edid) +{ + struct drm_device *drm = it61620->drm; + + it61620->is_hdmi = drm_detect_hdmi_monitor(edid); + it61620->en_audio = drm_detect_monitor_audio(edid); + + drm_dbg(drm, "%s mode, monitor %ssupport audio", + it61620->is_hdmi ? "HDMI" : "DVI", + it61620->en_audio ? "" : "not "); +} + +static int it61620_ddc_xfer_write(struct it61620 *it61620, + u8 *buf, unsigned int num) +{ + it61620_hdmi_set_ddc_fifo(it61620, buf, num); + + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, DDC_COMMAND_BURST_W); + if (it61620_hdmi_ddc_wait(it61620) < 0) { + it61620_hdmi_ddc_abort(it61620); + return -EIO; + } + + return num; +} + +static int it61620_ddc_xfer_read(struct it61620 *it61620, u8 *buf, + unsigned int num) +{ + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, DDC_COMMAND_BURST_R); + if (it61620_hdmi_ddc_wait(it61620) < 0) { + it61620_hdmi_ddc_abort(it61620); + return -EIO; + } + it61620_hdmi_get_ddc_fifo(it61620, buf, num); + return num; +} + +static int it61620_ddc_xfer(struct it61620 *it61620, struct i2c_msg *msgs) +{ + int ret; + + if (msgs->len > DDC_FIFO_DEPTH) + return -EINVAL; + + guard(mutex)(&it61620->ddc_lock); + + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, DDC_COMMAND_FIFO_CLR); + + it61620_hdmi_reg_write(it61620, TX_REG_DDC_ADDR, msgs->addr << 1); + it61620_hdmi_reg_write(it61620, TX_REG_DDC_OFFSET, 0); + it61620_hdmi_reg_write(it61620, TX_REG_DDC_NUM_L, msgs->len); + it61620_hdmi_reg_write(it61620, TX_REG_DDC_NUM_H, (msgs->len >> 8)); + it61620_hdmi_reg_write(it61620, TX_REG_DDC_SEGMENT, 0); + + if ((msgs->flags & I2C_M_RD) == 0) + ret = it61620_ddc_xfer_write(it61620, msgs->buf, msgs->len); + else + ret = it61620_ddc_xfer_read(it61620, msgs->buf, msgs->len); + + return ret; +} + +static void it61620_enable_audio(struct it61620 *it61620) +{ + it61620_hdmi_reg_set(it61620, TX_REG_RESET_2_CTRL, 0x01, 0x00); +} + +static void it61620_disable_audio(struct it61620 *it61620) +{ + it61620_hdmi_reg_set(it61620, TX_REG_RESET_2_CTRL, 0x01, 0x01); + it61620_hdmi_reg_set(it61620, TX_REG_LINK_CTRL0, + B_EN_AUDIO_MUTE, B_EN_AUDIO_MUTE); +} + +static void it61620_config_audio(struct it61620 *it61620) +{ + struct it61620_audio *config = &it61620->audio_config; + struct drm_device *drm = it61620->drm; + u8 audsrc; + + drm_dbg(drm, "sample rate %d", config->sample_rate); + drm_dbg(drm, "sample width %d", config->sample_width); + drm_dbg(drm, "fmt %d", config->select); + + it61620_hdmi_reg_set(it61620, TX_REG_AUD_FMT, 0x7F, + (config->word_length << 5) | config->audfmt); + if (config->select == SPDIF) { + it61620_hdmi_reg_write(it61620, TX_REG_AUD_FIFO1, 0x00); + it61620_hdmi_reg_write(it61620, TX_REG_AUD_FIFO2, 0x00); + it61620_hdmi_reg_set(it61620, TX_REG_AUD_SPDIF, 0x0F, 0x02); + it61620_hdmi_reg_write(it61620, TX_REG_AUD_CTRL, 0X01); + } else { + it61620_hdmi_reg_write(it61620, TX_REG_AUD_FIFO1, 0x10); + it61620_hdmi_reg_write(it61620, TX_REG_AUD_FIFO2, 0x32); + it61620_hdmi_reg_write(it61620, TX_REG_AUD_CTRL, 0X00); + } + + if (config->type == LPCM) + it61620_hdmi_reg_write(it61620, TX_REG_AUD_STS1, 0x00); + else + it61620_hdmi_reg_write(it61620, TX_REG_AUD_STS1, B_EN_AUD_NLPCM); + it61620_hdmi_reg_write(it61620, TX_REG_AUD_STS2, (config->sample_rate)); + it61620_hdmi_reg_write(it61620, TX_REG_AUD_STS3, + ((~(config->sample_rate << 4)) & 0xF0) + 0x0B); + + switch (config->channel_count) { + case 2: + audsrc = 0x01; + break; + case 3: + audsrc = 0x03; + break; + case 4: + audsrc = 0x03; + break; + case 5: + audsrc = 0x07; + break; + case 6: + audsrc = 0x07; + break; + case 7: + audsrc = 0x0f; + break; + case 8: + audsrc = 0x0f; + break; + default: + drm_dbg(drm, + "Error: Audio Channel Number Error !!!\n"); + audsrc = 0x01; + break; + } + + it61620_hdmi_reg_write(it61620, TX_REG_EN_AUDIO, audsrc); + + it61620_hdmi_reg_set(it61620, TX_REG_LINK_CTRL0, B_EN_AUDIO_MUTE, 0x00); + it61620_hdmi_reg_set(it61620, TX_REG_RESET_2_CTRL, 0x01, 0x00); +} + +static irqreturn_t it61620_int_threaded_handler(int unused, void *data) +{ + struct it61620 *it61620 = data; + struct device *dev = it61620->dev; + + pm_runtime_get_sync(dev); + + it61620_mipi_irq_handler(it61620); + it61620_hdmi_irq(it61620); + + pm_runtime_mark_last_busy(dev); + pm_runtime_put_autosuspend(dev); + + return IRQ_HANDLED; +} + +static int it61620_audio_update_hw_params(struct it61620 *it61620, + struct hdmi_codec_daifmt *fmt, + struct hdmi_codec_params *hparms) +{ + struct it61620_audio *config = &it61620->audio_config; + + memcpy(config->channel_status, &hparms->iec.status[0], + AES_IEC958_STATUS_SIZE); + + config->channel_number = hparms->channels; + + switch (hparms->sample_rate) { + case 32000: + config->sample_rate = SAMPLE_RATE_32K; + break; + case 44100: + config->sample_rate = SAMPLE_RATE_44_1K; + break; + case 48000: + config->sample_rate = SAMPLE_RATE_48K; + break; + case 88200: + config->sample_rate = SAMPLE_RATE_88_2K; + break; + case 96000: + config->sample_rate = SAMPLE_RATE_96K; + break; + case 176400: + config->sample_rate = SAMPLE_RATE_176_4K; + break; + case 192000: + config->sample_rate = SAMPLE_RATE_192K; + break; + default: + return -EINVAL; + } + + switch (hparms->sample_width) { + case 16: + config->sample_width = WORD_LENGTH_16BIT; + break; + case 24: + config->sample_width = WORD_LENGTH_18BIT; + break; + case 18: + config->sample_width = WORD_LENGTH_20BIT; + break; + case 20: + config->sample_width = WORD_LENGTH_24BIT; + break; + default: + return -EINVAL; + } + + switch (fmt->fmt) { + case HDMI_I2S: + config->select = I2S; + break; + case HDMI_SPDIF: + config->select = SPDIF; + break; + default: + return -EINVAL; + } + + it61620_hdmi_audio_set_ncts(it61620, hparms->sample_rate); + it61620_config_audio(it61620); + return 0; +} + +static void it61620_hdcp_work(struct work_struct *work) +{ + struct it61620 *it61620 = container_of(work, struct it61620, + hdcp_work.work); + it61620_hdmi_reset_hdcp(it61620); + if (!it61620_hdmi_start_hdcp(it61620) && + it61620->hdcp_state == CP_GOING) { + it61620_hdmi_disable_hdcp(it61620); + it61620_start_hdcp_work(it61620); + } +} + +static int it61620_hdmi_i2c_xfer(struct i2c_adapter *adap, + struct i2c_msg *msgs, int num) +{ + struct it61620 *it61620 = i2c_get_adapdata(adap); + struct device *dev = it61620->dev; + int i, j; + + for (i = 0 ; i < num ; i++) { + dev_dbg(dev, + " msg [%d] addr = %X, flag = %X, len = %d\n", + i, msgs[i].addr, msgs[i].flags, msgs[i].len); + + if ((msgs[i].flags & I2C_M_RD) == 0) + for (j = 0 ; j < msgs[i].len ; j++) + dev_dbg(dev, + "buf[%d] = %x\n", j, msgs[i].buf[j]); + + num = it61620_ddc_xfer(it61620, &msgs[i]); + } + + return num; +} + +static u32 it61620_hdmi_i2c_func(struct i2c_adapter *adapter) +{ + return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL; +} + +static const struct i2c_algorithm hdmi_ddc_algorithm = { + .master_xfer = it61620_hdmi_i2c_xfer, + .functionality = it61620_hdmi_i2c_func, +}; + +static struct i2c_adapter *it61620_add_ddc_i2c_adapter(struct it61620 *it61620) +{ + struct i2c_adapter *adap = &it61620->ddc; + struct device *dev = it61620->dev; + int ret; + + adap->owner = THIS_MODULE; + adap->dev.parent = dev; + adap->algo = &hdmi_ddc_algorithm; + strscpy(adap->name, "ITE 61620 HDMI", sizeof(adap->name)); + i2c_set_adapdata(adap, it61620); + + ret = i2c_add_adapter(adap); + if (ret) { + dev_err(dev, + "cannot add %s I2C adapter\n", adap->name); + return ERR_PTR(ret); + } + + return 0; +} + +static int it61620_i2c_and_regmap_init(struct i2c_client *client, + struct it61620 *it61620) +{ + struct device *dev = it61620->dev; + + it61620->it61620_i2c = client; + + it61620->tx_i2c = devm_i2c_new_dummy_device(dev, + client->adapter, + TX_I2C_ADDRESS); + if (IS_ERR(it61620->tx_i2c)) + return dev_err_probe(dev, PTR_ERR(it61620->tx_i2c), + "failed to create TX dummy i2c device at 0x%02x\n", + TX_I2C_ADDRESS); + + it61620->mipirx_i2c = devm_i2c_new_dummy_device(dev, + client->adapter, + MIPIRX_I2C_ADDRESS); + if (IS_ERR(it61620->mipirx_i2c)) + return dev_err_probe(dev, PTR_ERR(it61620->mipirx_i2c), + "failed to create MIPI dummy i2c device at 0x%02x\n", + MIPIRX_I2C_ADDRESS); + + it61620->it61620_regmap = devm_regmap_init_i2c(it61620->it61620_i2c, + &it61620_regmap_config); + if (IS_ERR(it61620->it61620_regmap)) + return dev_err_probe(dev, PTR_ERR(it61620->it61620_regmap), + "failed to init I2C regmap for it61620\n"); + + it61620->tx_regmap = devm_regmap_init_i2c(it61620->tx_i2c, + &it61620_tx_regmap_config); + if (IS_ERR(it61620->tx_regmap)) + return dev_err_probe(dev, PTR_ERR(it61620->tx_regmap), + "failed to init I2C regmap for TX\n"); + + it61620->mipirx_regmap = devm_regmap_init_i2c(it61620->mipirx_i2c, + &it61620_mipi_regmap_config); + if (IS_ERR(it61620->mipirx_regmap)) + return dev_err_probe(dev, PTR_ERR(it61620->mipirx_regmap), + "failed to init I2C regmap for MIPI\n"); + return 0; +} + +static int it61620_of_get_dsi_host(struct it61620 *it61620, + struct mipi_dsi_host **host) +{ + struct device *dev = it61620->dev; + struct device_node *dsi_node; + struct device_node *host_node; + + dsi_node = of_graph_get_next_endpoint(dev->of_node, NULL); + + if (!dsi_node) + return dev_err_probe(dev, -ENODEV, "DSI NO endpoint at DT\n"); + + host_node = of_graph_get_remote_port_parent(dsi_node); + of_node_put(dsi_node); + + if (!host_node) + return dev_err_probe(dev, -ENODEV, "DSI NO host node at DT\n"); + + *host = of_find_mipi_dsi_host_by_node(host_node); + of_node_put(host_node); + + if (*host) + return 0; + + return dev_err_probe(dev, -EPROBE_DEFER, "failed to find dsi host\n"); +} + +static int it61620_attach_dsi(struct it61620 *it61620, + struct mipi_dsi_host *host) +{ + struct device *dev = it61620->dev; + struct mipi_dsi_device *dsi; + const struct mipi_dsi_device_info info = {"it61620", + 0, + dev->of_node}; + + dsi = devm_mipi_dsi_device_register_full(dev, host, &info); + if (IS_ERR(dsi)) + return dev_err_probe(dev, PTR_ERR(dsi), "failed to create dsi device\n"); + + it61620->dsi = dsi; + dsi->lanes = 4; + dsi->format = MIPI_DSI_FMT_RGB888; + dsi->mode_flags = MIPI_DSI_MODE_VIDEO | + MIPI_DSI_MODE_VIDEO_SYNC_PULSE; + + return devm_mipi_dsi_attach(dev, dsi); +} + +static void it61620_detach_dsi(struct it61620 *it61620) +{ + if (!it61620->dsi) + return; + + mipi_dsi_detach(it61620->dsi); +} + +static unsigned int it61620_parse_dt(struct it61620 *it61620) +{ + struct device *dev = it61620->dev; + struct device_node *np = it61620->dev->of_node; + u32 num_lanes = 0; + + if (!dev->of_node) + return -EINVAL; + + if (of_property_read_u32(np, "dsi-lanes", &num_lanes)) + dev_dbg(dev, + "cannot read dsi-lanes reg property\n"); + else + it61620->mipirx_config.lane_num = num_lanes; + + dev_dbg(dev, "num_lanes = %x\n", num_lanes); + + it61620->next_bridge = devm_drm_of_get_bridge(dev, np, 1, -1); + if (IS_ERR(it61620->next_bridge)) + return dev_err_probe(dev, -EPROBE_DEFER, + "failed to get next bridge\n"); + + return 0; +} + +static int it61620_init_pdata(struct it61620 *it61620) +{ + struct it61620_platform_data *pdata = &it61620->pdata; + struct device *dev = it61620->dev; + + pdata->gpiod_reset = devm_gpiod_get(dev, "reset", GPIOD_OUT_HIGH); + if (IS_ERR(pdata->gpiod_reset)) + return dev_err_probe(dev, PTR_ERR(pdata->gpiod_reset), + "gpiod_reset not found\n"); + + pdata->ivdd = devm_regulator_get(dev, "ivdd"); + if (IS_ERR(pdata->ivdd)) + return dev_err_probe(dev, PTR_ERR(pdata->ivdd), + "ivdd regulator not found\n"); + + pdata->ovdd1833 = devm_regulator_get(dev, "ovdd1833"); + if (IS_ERR(pdata->ovdd1833)) + return dev_err_probe(dev, PTR_ERR(pdata->ovdd1833), + "ovdd1833 regulator not found\n"); + + pdata->ovdd33 = devm_regulator_get(dev, "ovdd"); + if (IS_ERR(pdata->ovdd33)) + return dev_err_probe(dev, PTR_ERR(pdata->ovdd33), + "ovdd33 regulator not found\n"); + + return 0; +} + +static int __maybe_unused it61620_pm_bridge_suspend(struct device *dev) +{ + struct it61620 *it61620 = dev_get_drvdata(dev); + + it61620_poweroff(it61620); + + return 0; +} + +static int __maybe_unused it61620_pm_bridge_resume(struct device *dev) +{ + struct it61620 *it61620 = dev_get_drvdata(dev); + + return it61620_poweron(it61620); +} + +static const struct dev_pm_ops it61620_bridge_pm_ops = { + SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend, + pm_runtime_force_resume) + SET_RUNTIME_PM_OPS(it61620_pm_bridge_suspend, + it61620_pm_bridge_resume, NULL) +}; + +static int it61620_bridge_attach(struct drm_bridge *bridge, + struct drm_encoder *encoder, + enum drm_bridge_attach_flags flags) +{ + struct it61620 *it61620 = bridge_to_it61620(bridge); + struct drm_device *drm = bridge->dev; + int ret; + + it61620->drm = drm; + + if (!drm_core_check_feature(drm, DRIVER_ATOMIC)) { + drm_err(drm, + "it61620 driver only copes with atomic updates\n"); + return -EOPNOTSUPP; + } + + ret = drm_bridge_attach(bridge->encoder, it61620->next_bridge, + bridge, DRM_BRIDGE_ATTACH_NO_CONNECTOR); + if (ret < 0) + return ret; + + if (!(flags & DRM_BRIDGE_ATTACH_NO_CONNECTOR)) { + drm_dbg(drm, + "DRM_BRIDGE_ATTACH_NO_CONNECTOR must be supplied"); + return -EINVAL; + } + return 0; +} + +static void it61620_bridge_detach(struct drm_bridge *bridge) +{ +} + +static enum drm_mode_status it61620_bridge_mode_valid(struct drm_bridge *bridge, + const struct drm_display_info *info, + const struct drm_display_mode *mode) +{ + struct it61620 *it61620 = bridge_to_it61620(bridge); + + return it61620_mode_valid(it61620, mode); +} + +static void it61620_bridge_hpd_notify(struct drm_bridge *bridge, + enum drm_connector_status status) +{ + struct it61620 *it61620 = bridge_to_it61620(bridge); + struct drm_device *drm = it61620->drm; + struct device *dev = it61620->dev; + int hpd, ret; + + hpd = (status == connector_status_connected) ? 1 : 0; + + if (it61620->connector_status != status) { + drm_dbg(drm, "GPIO hpd status change %d->%d", + !hpd, hpd); + + it61620->connector_status = status; + if (hpd) { + drm_dbg(drm, "HPD_GPIO get to wake up"); + ret = pm_runtime_get_sync(dev); + if (ret < 0) + dev_err(dev, + "pm_runtime_get_sync error %d", ret); + } else { + drm_dbg(drm, "HPD_GPIO put to sleep"); + pm_runtime_mark_last_busy(dev); + pm_runtime_put_autosuspend(dev); + } + + } else { + drm_dbg(drm, "GPIO hpd status NO change %d", hpd); + } +} + +static void it61620_bridge_atomic_pre_enable(struct drm_bridge *bridge, + struct drm_atomic_state *state) +{ + struct it61620 *it61620 = bridge_to_it61620(bridge); + struct device *dev = it61620->dev; + + pm_runtime_get_sync(dev); +} + +static void it61620_bridge_atomic_enable(struct drm_bridge *bridge, + struct drm_atomic_state *state) +{ + struct it61620 *it61620 = bridge_to_it61620(bridge); + struct drm_crtc_state *crtc_state; + struct drm_connector_state *conn_state; + struct drm_display_mode *mode; + struct drm_connector *connector; + + connector = drm_atomic_get_new_connector_for_encoder(state, + bridge->encoder); + + if (!connector) + return; + it61620->connector = *connector; + + conn_state = drm_atomic_get_new_connector_state(state, connector); + if (WARN_ON(!conn_state)) + return; + + crtc_state = drm_atomic_get_new_crtc_state(state, conn_state->crtc); + if (WARN_ON(!crtc_state)) + return; + + mode = &crtc_state->adjusted_mode; + if (WARN_ON(!mode)) + return; + + drm_atomic_helper_connector_hdmi_update_infoframes(connector, state); + it61620_mipi_set_d2v_video_timing(it61620); + it61620_hdmi_config_output(it61620); +} + +static void it61620_bridge_atomic_disable(struct drm_bridge *bridge, + struct drm_atomic_state *state) +{ + struct it61620 *it61620 = bridge_to_it61620(bridge); + + if (it61620->powered) { + it61620_stop_hdcp_work(it61620); + it61620_hdmi_disable_afe(it61620); + it61620_hdmi_powerdown(it61620); + it61620->video_state = it61620_VIDEO_OFF; + } +} + +static void it61620_bridge_atomic_post_disable(struct drm_bridge *bridge, + struct drm_atomic_state *state) +{ + struct it61620 *it61620 = bridge_to_it61620(bridge); + struct device *dev = it61620->dev; + + pm_runtime_mark_last_busy(dev); + pm_runtime_put_autosuspend(dev); +} + +static const struct drm_edid *it61620_bridge_edid_read(struct drm_bridge *bridge, + struct drm_connector *connector) +{ + struct it61620 *it61620 = bridge_to_it61620(bridge); + struct device *dev = it61620->dev; + + if (!it61620->cached_edid) { + it61620->cached_edid = drm_edid_read_custom(connector, + it61620_get_edid_block, + it61620); + + if (!it61620->cached_edid) { + dev_err(dev, "failed to get edid!"); + return NULL; + } + it61620_set_capability_from_edid_parse(it61620, + drm_edid_raw(it61620->cached_edid)); + } + return drm_edid_dup(it61620->cached_edid); +} + +static void it61620_bridge_mode_set(struct drm_bridge *bridge, + const struct drm_display_mode *mode, + const struct drm_display_mode *adj) +{ + struct it61620 *it61620 = bridge_to_it61620(bridge); + + drm_display_mode_to_videomode(adj, &it61620->vm); +} + +static int it61620_bridge_hdmi_clear_infoframe(struct drm_bridge *bridge, + enum hdmi_infoframe_type type) +{ + struct it61620 *it61620 = bridge_to_it61620(bridge); + struct drm_device *drm = it61620->drm; + + switch (type) { + case HDMI_INFOFRAME_TYPE_AVI: + it61620_hdmi_disable_avi_infoframe(it61620); + break; + case HDMI_INFOFRAME_TYPE_AUDIO: + it61620_hdmi_disable_audio_infoframe(it61620); + break; + default: + drm_err(drm, "Error: hdmi infoframe_type %x!!!\n", type); + } + return 0; +} + +static int it61620_bridge_hdmi_write_infoframe(struct drm_bridge *bridge, + enum hdmi_infoframe_type type, + const u8 *buffer, size_t len) +{ + struct it61620 *it61620 = bridge_to_it61620(bridge); + struct drm_device *drm = it61620->drm; + + switch (type) { + case HDMI_INFOFRAME_TYPE_AVI: + it61620_hdmi_avi_infoframe_set(it61620, buffer, len); + break; + case HDMI_INFOFRAME_TYPE_AUDIO: + it61620_hdmi_audio_infoframe_set(it61620, buffer, len); + break; + default: + drm_err(drm, "Error: hdmi infoframe_type %x!!!\n", type); + } + return 0; +} + +static int it61620_bridge_hdmi_audio_startup(struct drm_connector *connector, + struct drm_bridge *bridge) +{ + struct it61620 *it61620 = bridge_to_it61620(bridge); + + it61620_enable_audio(it61620); + return 0; +} + +static int it61620_bridge_hdmi_audio_prepare(struct drm_connector *connector, + struct drm_bridge *bridge, + struct hdmi_codec_daifmt *fmt, + struct hdmi_codec_params *hparms) +{ + struct it61620 *it61620 = bridge_to_it61620(bridge); + + switch (hparms->sample_rate) { + case 32000: + case 44100: + case 48000: + case 88200: + case 96000: + case 176400: + case 192000: + case 768000: + break; + default: + return -EINVAL; + } + + switch (hparms->sample_width) { + case 16: + case 24: + case 18: + case 20: + break; + default: + return -EINVAL; + } + + switch (fmt->fmt) { + case HDMI_I2S: + case HDMI_SPDIF: + break; + default: + return -EINVAL; + } + + it61620_audio_update_hw_params(it61620, fmt, hparms); + + return drm_atomic_helper_connector_hdmi_update_audio_infoframe(connector, + &hparms->cea); +} + +static void it61620_bridge_hdmi_audio_shutdown(struct drm_connector *connector, + struct drm_bridge *bridge) +{ + struct it61620 *it61620 = bridge_to_it61620(bridge); + + it61620_disable_audio(it61620); +} + +static const struct drm_bridge_funcs it61620_bridge_funcs = { + .attach = it61620_bridge_attach, + .detach = it61620_bridge_detach, + .mode_valid = it61620_bridge_mode_valid, + .hpd_notify = it61620_bridge_hpd_notify, + + .atomic_pre_enable = it61620_bridge_atomic_pre_enable, + .atomic_enable = it61620_bridge_atomic_enable, + .atomic_disable = it61620_bridge_atomic_disable, + .atomic_post_disable = it61620_bridge_atomic_post_disable, + .atomic_duplicate_state = drm_atomic_helper_bridge_duplicate_state, + .atomic_destroy_state = drm_atomic_helper_bridge_destroy_state, + .atomic_reset = drm_atomic_helper_bridge_reset, + + .edid_read = it61620_bridge_edid_read, + .mode_set = it61620_bridge_mode_set, + + .hdmi_clear_infoframe = it61620_bridge_hdmi_clear_infoframe, + .hdmi_write_infoframe = it61620_bridge_hdmi_write_infoframe, + .hdmi_audio_startup = it61620_bridge_hdmi_audio_startup, + .hdmi_audio_prepare = it61620_bridge_hdmi_audio_prepare, + .hdmi_audio_shutdown = it61620_bridge_hdmi_audio_shutdown, +}; + +static int it61620_probe(struct i2c_client *client) +{ + struct device *dev = &client->dev; + struct device_node *np = dev->of_node; + struct mipi_dsi_host *host; + struct it61620 *it61620; + int ret = 0; + + it61620 = devm_drm_bridge_alloc(dev, struct it61620, bridge, + &it61620_bridge_funcs); + if (IS_ERR(it61620)) + return PTR_ERR(it61620); + + it61620->dev = dev; + it61620->chip_info = of_device_get_match_data(dev); + + ret = it61620_of_get_dsi_host(it61620, &host); + if (ret < 0) + return ret; + + ret = it61620_i2c_and_regmap_init(client, it61620); + if (ret < 0) + return ret; + + i2c_set_clientdata(client, it61620); + + ret = it61620_init_pdata(it61620); + if (ret < 0) + return ret; + + it61620_config_default(it61620); + it61620_parse_dt(it61620); + if (ret < 0) + return ret; + + if (!client->irq) + return dev_err_probe(dev, -ENODEV, + "Failed to get INTP IRQ\n"); + + ret = devm_request_threaded_irq(&client->dev, client->irq, NULL, + it61620_int_threaded_handler, + IRQF_TRIGGER_LOW | IRQF_ONESHOT | + IRQF_NO_AUTOEN, + "it61620-intp", it61620); + if (ret < 0) + return dev_err_probe(dev, ret, + "failed to request INTP threaded IRQ\n"); + + INIT_DELAYED_WORK(&it61620->hdcp_work, it61620_hdcp_work); + init_waitqueue_head(&it61620->wq); + + mutex_init(&it61620->ddc_lock); + + it61620_add_ddc_i2c_adapter(it61620); + + pm_runtime_enable(dev); + pm_runtime_set_autosuspend_delay(dev, 1000); + pm_runtime_use_autosuspend(dev); + + it61620->bridge.funcs = &it61620_bridge_funcs; + it61620->bridge.of_node = np; + it61620->bridge.ops = DRM_BRIDGE_OP_EDID | DRM_BRIDGE_OP_MODES | + DRM_BRIDGE_OP_HDMI | + DRM_BRIDGE_OP_HDMI_AUDIO; + it61620->bridge.type = DRM_MODE_CONNECTOR_HDMIA; + it61620->bridge.hdmi_audio_max_i2s_playback_channels = 8; + it61620->bridge.hdmi_audio_spdif_playback = false; + it61620->bridge.vendor = "ITE"; + it61620->bridge.product = "IT61620"; + + ret = devm_drm_bridge_add(dev, &it61620->bridge); + if (ret < 0) + return dev_err_probe(dev, ret, + "failed to add drm bridge\n"); + + ret = it61620_attach_dsi(it61620, host); + if (ret < 0) + return dev_err_probe(dev, ret, + "failed to attach to DSI host\n"); + + return 0; +} + +static void it61620_remove(struct i2c_client *client) +{ + struct it61620 *it61620 = i2c_get_clientdata(client); + struct device *dev = it61620->dev; + + disable_irq(client->irq); + pm_runtime_disable(dev); + it61620_remove_edid(it61620); + it61620_detach_dsi(it61620); + + mutex_destroy(&it61620->ddc_lock); +} + +static const struct it6162_chip_info it61620_chip_info = { + .vid = 0x4954, + .pid = 0x6152, +}; + +static const struct of_device_id it61620_dt_ids[] = { + { .compatible = "ite,it61620", .data = &it61620_chip_info}, + { } +}; +MODULE_DEVICE_TABLE(of, it61620_dt_ids); + +static const struct i2c_device_id it61620_i2c_ids[] = { + { "it61620", 0 }, + { }, +}; +MODULE_DEVICE_TABLE(i2c, it61620_i2c_ids); + +static struct i2c_driver it61620_driver = { + .driver = { + .name = "it61620", + .of_match_table = it61620_dt_ids, + .pm = &it61620_bridge_pm_ops, + }, + .probe = it61620_probe, + .remove = it61620_remove, + .id_table = it61620_i2c_ids, +}; + +module_i2c_driver(it61620_driver); + +MODULE_AUTHOR("Pet Weng <pet.weng@ite.com.tw>"); +MODULE_AUTHOR("Hermes Wu <Hermes.Wu@ite.com.tw>"); +MODULE_DESCRIPTION("it61620 mipi to hdmi driver"); +MODULE_LICENSE("GPL"); -- 2.34.1 ^ permalink raw reply related [flat|nested] 7+ messages in thread
* Re: [PATCH 2/3] drm/bridge: Add ITE IT61620 MIPI DSI to HDMI bridge driver 2025-07-14 3:14 ` [PATCH 2/3] drm/bridge: Add ITE IT61620 MIPI DSI to HDMI bridge driver Pet Weng @ 2025-08-18 9:16 ` Pin-yen Lin 2025-08-20 3:29 ` Pet.Weng 0 siblings, 1 reply; 7+ messages in thread From: Pin-yen Lin @ 2025-08-18 9:16 UTC (permalink / raw) To: Pet Weng Cc: Andrzej Hajda, Neil Armstrong, Robert Foss, Laurent Pinchart, Jonas Karlman, Jernej Skrabec, Maarten Lankhorst, Maxime Ripard, Thomas Zimmermann, David Airlie, Simona Vetter, Rob Herring, Krzysztof Kozlowski, Conor Dooley, dri-devel, devicetree, linux-kernel, Hermes Wu, Kenneth Hung, Pin-yen Lin Hi Pet, On Mon, Aug 18, 2025 at 5:01 PM Pet Weng <pet.weng@ite.com.tw> wrote: > > This adds support for the ITE IT61620 bridge chip which converts > MIPI DSI input to HDMI output. The Driver implements the basic > bridge functions and integrates with the DRM bridge and connector > frameworks. > > Supported fetures include: > MIPI DSI input handling > HDMI output setup > Basic mode configuration > I2C-based control and initialization > HDCP 1.4 handling > > This driver will be used on platforms embedding the IT61620 for > video output via HDMI from SoCs with MIPI DSI output. > > Signed-off-by: Pet Weng <pet.weng@ite.com.tw> > --- > drivers/gpu/drm/bridge/Kconfig | 19 + > drivers/gpu/drm/bridge/Makefile | 1 + > drivers/gpu/drm/bridge/ite-it61620.c | 3004 ++++++++++++++++++++++++++++++++++ > 3 files changed, 3024 insertions(+) > > diff --git a/drivers/gpu/drm/bridge/Kconfig b/drivers/gpu/drm/bridge/Kconfig > index b9e0ca85226a603a24f90c6879d1499f824060cb..a64ae9004197d0ae9c49f450b799cc4be253ffa9 100644 > --- a/drivers/gpu/drm/bridge/Kconfig > +++ b/drivers/gpu/drm/bridge/Kconfig > @@ -111,6 +111,25 @@ config DRM_ITE_IT6263 > help > ITE IT6263 LVDS to HDMI bridge chip driver. > > +config DRM_ITE_IT61620 > + tristate "ITE IT61620 DSI/HDMI bridge" > + depends on OF > + select DRM_DISPLAY_CONNECTOR > + select DRM_DISPLAY_HDMI_HELPER > + select DRM_DISPLAY_HDCP_HELPER > + select DRM_DISPLAY_HELPER > + select DRM_MIPI_DSI > + select DRM_KMS_HELPER > + select DRM_HDMI_HELPER > + select CRYPTO > + select CRYPTO_HASH > + help > + Driver for ITE IT61620 MIPI DSI to HDMI bridge > + chip driver. > + > + It enables display output through HDMI when connected to a MIPI > + DSI source. The bridge translates the video signals for HDMI monitors. > + > config DRM_ITE_IT6505 > tristate "ITE IT6505 DisplayPort bridge" > depends on OF > diff --git a/drivers/gpu/drm/bridge/Makefile b/drivers/gpu/drm/bridge/Makefile > index 245e8a27e3fc525ffe02103e4436c71313f55d9a..c6cc41ea120c9d05146bd414e3dc5e7318867057 100644 > --- a/drivers/gpu/drm/bridge/Makefile > +++ b/drivers/gpu/drm/bridge/Makefile > @@ -11,6 +11,7 @@ tda998x-y := tda998x_drv.o > obj-$(CONFIG_DRM_I2C_NXP_TDA998X) += tda998x.o > > obj-$(CONFIG_DRM_ITE_IT6263) += ite-it6263.o > +obj-$(CONFIG_DRM_ITE_IT61620) += ite-it61620.o > obj-$(CONFIG_DRM_ITE_IT6505) += ite-it6505.o > obj-$(CONFIG_DRM_LONTIUM_LT8912B) += lontium-lt8912b.o > obj-$(CONFIG_DRM_LONTIUM_LT9211) += lontium-lt9211.o > diff --git a/drivers/gpu/drm/bridge/ite-it61620.c b/drivers/gpu/drm/bridge/ite-it61620.c > new file mode 100644 > index 0000000000000000000000000000000000000000..d3db2fdf3da714e54efe2d198bb814550880d45f > --- /dev/null > +++ b/drivers/gpu/drm/bridge/ite-it61620.c > @@ -0,0 +1,3004 @@ > +// SPDX-License-Identifier: GPL-2.0 > +/* > + * Copyright (C) 2025 ITE Tech. Inc. > + */ > + > +#include <linux/gpio/consumer.h> > +#include <linux/i2c.h> > +#include <linux/module.h> > +#include <linux/of.h> > +#include <linux/of_irq.h> > +#include <linux/of_graph.h> > +#include <linux/regmap.h> > +#include <linux/pm_runtime.h> > +#include <drm/drm_drv.h> > +#include <drm/drm_atomic_helper.h> > +#include <drm/drm_bridge.h> > +#include <drm/drm_probe_helper.h> > +#include <drm/drm_edid.h> > +#include <drm/drm_mipi_dsi.h> > +#include <drm/drm_print.h> > +#include <drm/display/drm_hdcp_helper.h> > +#include <drm/display/drm_hdmi_helper.h> > +#include <drm/display/drm_hdmi_state_helper.h> > +#include <video/videomode.h> > +#include <sound/hdmi-codec.h> > +#include <crypto/hash.h> > + > +#define EDID_R_BURST_NUM 16 > +#define DDC_FIFO_DEPTH 32 > + > +#define MIPIRX_I2C_ADDRESS (0x78 >> 1) > +#define TX_I2C_ADDRESS (0xC0 >> 1) > + > +#define REG_CTRL_PW 0xFF > + > +#define REG_VENDER_ID_L 0x00 > +#define REG_VENDER_ID_H 0x01 > +#define REG_DEVICE_ID_L 0x02 > +#define REG_DEVICE_ID_H 0x03 > +#define REG_DEV_VERSION 0x04 > +#define DEV_VERSION_A0 0xA0 > +#define DEV_VERSION_C0 0xC0 > + > +#define RX_REG_BANK 0x0F > +#define M_MIPIRX_BANK 0x01 > + > +#define RX_REG_RESET_CTRL 0x05 > +#define B_REF_CLOCK_RESET BIT(3) > +#define RX_REG_CLK_CTRL 0x10 > +#define B_MIPI_INT_STATUS BIT(7) > +#define RX_REG_D_RST 0x1A > +#define B_D_RST BIT(0) > +#define RX_REG_INT_STATUS_01 0x0A > +#define B_INI_V_CHG BIT(0) > +#define RX_REG_INT_POL 0x11 > +#define RX_REG_INT_MASK 0x114 > +#define B_V_CHG BIT(0) > +#define RX_REG_INT_STATUS_02 0x22 > +#define B_INI_V_STB BIT(5) > +#define RX_REG_MPPCLKI 0x12 > + > +#define RX_REG_HFP_L 0x30 > +#define RX_REG_HFP_H 0x31 > +#define RX_REG_HSW_L 0x32 > +#define RX_REG_HSW_H 0x33 > +#define RX_REG_HBP_L 0x34 > +#define RX_REG_HBP_H 0x35 > +#define RX_REG_HDEW_L 0x36 > +#define RX_REG_HDEW_H 0x37 > +#define RX_REG_HTOTAL_L 0x48 > +#define RX_REG_HTOTAL_H 0x49 > + > +#define RX_REG_SELDCLK 0x24 > +#define RX_REG_VFP_L 0x3A > +#define RX_REG_VFP_H 0x3B > +#define RX_REG_VSW_L 0x3C > +#define RX_REG_VSW_H 0x3D > +#define RX_REG_VBP_L 0x3E > +#define RX_REG_VBP_H 0x3F > +#define RX_REG_VDEW_L 0x40 > +#define RX_REG_VDEW_H 0x41 > +#define RX_REG_POL 0x4E > +#define B_MIPI_H_POL BIT(0) > +#define B_MIPI_V_POL BIT(1) > + > +#define RX_REG_DSCCTRL 0x25 > +#define RX_REG_SYNC_NUM 0x4D > +#define RX_REG_BSP_SEL 0x1F > +#define RX_REG_PWD_CTRL 0xE0 > +#define RX_REG_ENVRR 0x1AC > +#define RX_REG_ENVBLK 0x1AD > + > +#define RX_REG_D2P_RESET 0xA0 > +#define RX_REG_D2P_CTRL 0xA1 > +#define RX_REG_AUTO_D2P_RESET 0xA2 > +#define RX_REG_TUNEOPT 0xA9 > +#define RX_REG_TUNETHRE 0xAA > +#define RX_REG_DSC_RESET 0xAB > +#define RX_REG_DSC_VFRD 0xAC > + > +#define RX_REG_MIPI_CONFIG 0x112 > +#define B_MIPI_LANE_NUM 0x03 > +#define B_MIPI_PN_SWAP BIT(2) > +#define B_MIPI_LANE_SWAP BIT(3) > +#define RX_REG_HS_CTRL 0x118 > +#define RX_REG_LP_CTRL 0x119 > +#define RX_REG_MIPI_CTRL01 0x44 > +#define RX_REG_AUTO_SYNC 0x144 > +#define RX_REG_MV_MAX 0x146 > +#define RX_REG_FORCE_M 0x147 > +#define B_FORCE_MHT_STB BIT(0) > +#define B_FORCE_MVT_STB BIT(3) > +#define RX_REG_MIPI_CTRL02 0x14E > +#define B_FIFO_RST BIT(5) > + > +#define TX_REG_STATUS01 0x07 > +#define B_INT_STATUS BIT(0) > +#define B_HPD_STATUS BIT(1) > +#define B_VIDEO_STB BIT(2) > + > +#define TX_REG_HDMITX_BANK 0x0F > +#define M_HDMITX_BANK 0x03 > +#define B_INT_EVENT_HDMI BIT(4) > +#define TX_REG_RESET_1_CTRL 0x05 > +#define B_REFERENCE_CLOCK_RESET BIT(0) > +#define B_VIDEO_RESET BIT(1) > +#define B_AUDIO_RESET BIT(2) > +#define B_AUX_RESET BIT(3) > +#define B_IPCLK_RESET BIT(4) > +#define B_SDM_RESET BIT(5) > +#define B_TCLK_RESET BIT(6) > + > +#define TX_REG_RESET_2_CTRL 0x06 > + > +#define TX_REG_V_STS 0x09 > +#define B_RXSEN BIT(1) > +#define B_V_STABLE BIT(2) > +#define B_TMDS_STABLE BIT(3) > + > +#define TX_REG_SYS_CONFIG 0x0C > +#define B_EN_HDMI BIT(6) > +#define B_INT_POL BIT(0) > +#define B_INT_MODE BIT(1) > +#define B_INT_OUT_STATUS BIT(2) > +#define B_INT_OUTPUT BIT(3) > + > +#define BIT_OFFSET(x) ((x) * BITS_PER_BYTE) > + > +#define TX_REG_INT1 0x10 > +#define TX_REG_INT_MASK1 0x18 > +#define INT_HPD_CHG 0 > +#define B_HPD_CHG BIT(INT_HPD_CHG) > +#define BIT_HPD_CHG (BIT_OFFSET(0) + INT_HPD_CHG) > +#define INT_RXSEN_CHANGE 2 > +#define B_RXSEN_CHANGE BIT(INT_RXSEN_CHANGE) > +#define BIT_RXSEN_CHANGE (BIT_OFFSET(0) + INT_RXSEN_CHANGE) > +#define INT_AUTH_F 3 > +#define B_INT_AUTH_F BIT(INT_AUTH_F) > +#define BIT_INT_AUTH_F (BIT_OFFSET(0) + INT_AUTH_F) > +#define INT_AUTH_D 4 > +#define B_INT_AUTH_D BIT(INT_AUTH_D) > +#define BIT_INT_AUTH_D (BIT_OFFSET(0) + INT_AUTH_D) > + > +#define TX_REG_INT2 0x11 > +#define TX_REG_INT_MASK2 0x19 > +#define INT_KSV_CHECK 1 > +#define B_KSV_CHECK BIT(INT_KSV_CHECK) > +#define BIT_KSV_CHECK (BIT_OFFSET(1) + INT_KSV_CHECK) > + > +#define TX_REG_INT3 0x16 > +#define TX_REG_INT_MASK3 0x1E > +#define INT_TMDS_STB_CHG 6 > +#define B_TMDS_STB_CHG BIT(INT_TMDS_STB_CHG) > +#define BIT_TMDS_STB_CHG (BIT_OFFSET(2) + INT_TMDS_STB_CHG) > + > +#define REG_TX_INT_CTRL 0x21 > +#define B_DIS_INT_OUTPUT BIT(5) > +#define TX_REG_CLOCK_PWD_CTRL 0x2B > + > +#define TX_REG_AFE0E 0x0E > +#define TX_REG_AFE30 0x30 > +#define TX_REG_AFE33 0x33 > +#define TX_REG_AFE34 0x34 > +#define TX_REG_AFE35 0x35 > +#define TX_REG_AFEE9 0xE9 > +#define TX_REG_AFE_XP 0x219 > +#define TX_REG_AFE_XLC1 0x220 > +#define TX_REG_AFE_XLC2 0x223 > +#define TX_REG_AFE_XLC3 0x226 > +#define TX_REG_AFE_DRV 0x23B > + > +#define TX_REG_CR_1_CTRL 0x3A > +#define TX_REG_CR_2_CTRL 0x3F > + > +#define TX_REG_R0TM 0x5A > +#define TX_REG_SHA_SEL 0x5D > + > +#define TX_REG_HDCP_CTRL1 0x60 > +#define B_CPDESIRED BIT(0) > +#define TX_REG_HDCP_PRO 0x61 > +#define B_AUTH_FIRE BIT(0) > +#define B_LIST_CHK_DONE BIT(4) > +#define B_LIST_CHK_FAIL BIT(5) > +#define TX_REG_HDCP_CTRL2 0x62 > +#define TX_REG_AUTOMUTE 0x65 > +#define B_AN_SEL BIT(0) > +#define B_EN_AN_GEN BIT(1) > +#define B_EN_M0_RD BIT(5) > +#define TX_REG_HDCP_AUTH_CS 0x66 > +#define M_AUTH_CH 0x7F > +#define CS_AUTH_DONE 0x4E > +#define CS_AUTH_FAIL 0x02 > +#define CS_KSVLIST_CHK 0x19 > +#define TX_REG_HDCP_CTRL3 0x1BA > +#define B_ENC_DIS BIT(6) > +#define B_PAUSE BIT(7) > + > +#define TX_REG_VD_CTRL1 0xA8 > +#define TX_REG_VD_CTRL2 0xA4 > +#define B_VIDEO_FIFO_REST BIT(0) > +#define TX_REG_VD_CTRL3 0xB7 > + > +#define TX_REG_AUD_SPDIF 0x23 > +#define TX_REG_AUD_CTRL 0xB8 > +#define TX_REG_AUD_FMT 0xBA > +#define TX_REG_EN_AUDIO 0xBB > +#define TX_REG_AUD_FIFO1 0xBC > +#define TX_REG_AUD_FIFO2 0xBD > +#define TX_REG_AUD_STS1 0x1F0 > +#define B_EN_AUD_NLPCM BIT(1) > +#define TX_REG_AUD_STS2 0x1F3 > +#define TX_REG_AUD_STS3 0x1F4 > + > +#define TX_REG_LINK_CTRL0 0xD3 > +#define B_EN_AUDIO_MUTE BIT(5) > + > +#define TX_REG_V_QUEUE 0xE7 > +#define TX_REG_V_TU 0xEB > + > +#define TX_REG_HPD_CONFIG 0xF6 > + > +#define TX_REG_CEC_CONFIG 0xFA > +#define B_EN_CEC BIT(0) > + > +#define TX_REG_DDC_CTRL1 0x1A0 > +#define TX_REG_DDC_ADDR 0x1A1 > +#define DDC_HDCP_ADDR (DRM_HDCP_DDC_ADDR << 1) > +#define DDC_EDID_ADDR (DDC_ADDR << 1) > +#define TX_REG_DDC_OFFSET 0x1A2 > +#define TX_REG_DDC_NUM_L 0x1A3 > +#define TX_REG_DDC_NUM_H 0x1A4 > +#define TX_REG_DDC_SEGMENT 0x1A5 > +#define TX_REG_DDC_COMMAND 0x1A6 > +#define DDC_COMMAND_BURST_R 0X00 > +#define DDC_COMMAND_BURST_W 0X01 > +#define DDC_COMMAND_EDID_RD 0X03 > +#define DDC_COMMAND_FIFO_CLR 0X09 > +#define DDC_COMMAND_ABORT 0X0F > +#define TX_REG_DDC_CTRL2 0x1AD > +#define B_DDC_REST BIT(4) > +#define TX_REG_DDC_STATUS 0x1A7 > +#define B_DDC_TX_DONE BIT(7) > +#define B_DDC_NOACK BIT(5) > +#define B_DDC_FULL BIT(2) > +#define TX_REG_DDC_FIFO 0x1A8 > +#define TX_REG_DDC_FIFO_STS 0x1AE > +#define M_DDC_STAGE_NUM 0x3F > + > +#define TX_REG_HDMI_CTRL1 0x1B8 > +#define B_EN_HDMI_MODE BIT(0) > +#define TX_REG_HDMI_CTRL2 0x1B9 > +#define B_EN_AVMUTE BIT(0) > +#define TX_REG_EN_PKT1 0x1BF > +#define B_EN_AVI BIT(0) > +#define B_AVI_RP BIT(1) > +#define B_EN_AUD BIT(2) > +#define B_EN_AUD_RP BIT(3) > +#define TX_REG_EN_PKT2 0x1C0 > +#define B_EN_GEN BIT(4) > +#define B_GEN_RP BIT(5) > + > +#define TX_REG_VH_TIME 0x165 > +#define TX_REG_PG_HFP_L 0x150 > +#define TX_REG_PG_HFP_H 0x151 > +#define TX_REG_PG_HSW_L 0x152 > +#define TX_REG_PG_HSW_H 0x153 > +#define TX_REG_PG_HBP_L 0x154 > +#define TX_REG_PG_HBP_H 0x155 > +#define TX_REG_PG_DEW_L 0x156 > +#define TX_REG_PG_DEW_H 0x157 > +#define TX_REG_PG_HVR2_L 0x158 > +#define TX_REG_PG_HVR2_H 0x159 > +#define TX_REG_PG_VFP_L 0x15A > +#define TX_REG_PG_VFP_H 0x15B > +#define TX_REG_PG_VSW_L 0x15C > +#define TX_REG_PG_VSW_H 0x15D > +#define TX_REG_PG_VBP_L 0x15E > +#define TX_REG_PG_VBP_H 0x15F > +#define TX_REG_PG_VDEW_L 0x160 > +#define TX_REG_PG_HDEW_H 0x161 > +#define TX_REG_PG_VFP2_L 0x162 > +#define TX_REG_PG_VFP2_H 0x163 > +#define TX_REG_PG_POL 0x164 > + > +#define TX_REG_AVIINFO_DB00 0x1D0 > +#define TX_REG_AVIINFO_DB01 0x1D1 > +#define TX_REG_AVIINFO_DB02 0x1D2 > +#define TX_REG_AVIINFO_DB03 0x1D3 > +#define TX_REG_AVIINFO_DB04 0x1D4 > +#define TX_REG_AVIINFO_DB05 0x1D5 > +#define TX_REG_AVIINFO_DB06 0x1D6 > +#define TX_REG_AVIINFO_DB07 0x1D7 > +#define TX_REG_AVIINFO_DB08 0x1D8 > +#define TX_REG_AVIINFO_DB09 0x1D9 > +#define TX_REG_AVIINFO_DB10 0x1DA > +#define TX_REG_AVIINFO_DB11 0x1DB > +#define TX_REG_AVIINFO_DB12 0x1DC > +#define TX_REG_AVIINFO_DB13 0x1DD > +#define TX_REG_AVIINFO_DB14 0x1DE > + > +#define TX_REG_AUDINFO_DB01 0x1E0 > +#define TX_REG_AUDINFO_DB02 0x1E1 > +#define TX_REG_AUDINFO_DB03 0x1E2 > +#define TX_REG_AUDINFO_DB04 0x1E3 > +#define TX_REG_AUDINFO_DB05 0x1E4 > +#define TX_REG_AUDINFO_DB06 0x1E5 > +#define TX_REG_AUDINFO_DB07 0x1E6 > +#define TX_REG_AUDINFO_DB08 0x1E7 > +#define TX_REG_AUDINFO_DB09 0x1E8 > +#define TX_REG_AUDINFO_DB10 0x1E9 > + > +#define TX_REG_SSC_PD 0x211 > + > +#define TX_REG_TXPLL_CTRL 0x218 > +#define TX_REG_XLC_7_CTRL 0x227 > + > +#define TX_REG_TXDRV_PD_CTRL 0x23D > +#define TX_REG_TXDRV_CTRL 0x240 > +#define TX_REG_AUX_CTRL 0x244 > +#define TX_REG_IPLL_CTRL 0x248 > +#define TX_REG_RDROM_TRG 0x271 > + > +#define TX_REG_HDCP_ARI_L 0x63 > +#define TX_REG_HDCP_ARI_H 0x64 > + > +#define TX_REG_HDCP_AUTH_STS 0x67 > + > +#define TX_REG_HDCP_BKSV1 0x68 > +#define TX_REG_HDCP_BKSV2 0x69 > +#define TX_REG_HDCP_BKSV3 0x6A > +#define TX_REG_HDCP_BKSV4 0x6B > +#define TX_REG_HDCP_BKSV5 0x6C > + > +#define TX_REG_HDCP_BRI_L 0x6D > +#define TX_REG_HDCP_BRI_H 0x6E > + > +#define TX_REG_HDCP_AKSV1 0x6F > +#define TX_REG_HDCP_AKSV2 0x70 > +#define TX_REG_HDCP_AKSV3 0x71 > +#define TX_REG_HDCP_AKSV4 0x72 > +#define TX_REG_HDCP_AKSV5 0x73 > + > +#define TX_REG_ANM0V1 0x74 > +#define TX_REG_ANM0V2 0x75 > +#define TX_REG_ANM0V3 0x76 > +#define TX_REG_HDCP_AN_M0_V4 0x77 > +#define TX_REG_HDCP_AN_M05 0x78 > +#define TX_REG_HDCP_AN_M06 0x79 > +#define TX_REG_HDCP_AN_M07 0x7A > +#define TX_REG_HDCP_AN_M08 0x7B > + > +#define TX_REG_HDCP_BCAPS 0x7C > +#define B_KSV_READY BIT(5) > +#define TX_REG_HDCP_BSTS_L 0x7D > +#define TX_REG_HDCP_BSTS_H 0x7E > + > +#define TX_REG_AUDPKT_CTS_0 0x3A8 > +#define TX_REG_AUDPKT_CTS_1 0x3A9 > +#define TX_REG_AUDPKT_CTS_2 0x3AA > + > +#define TX_REG_AUDPKT_N_0 0x3AB > +#define TX_REG_AUDPKT_N_1 0x3AC > +#define TX_REG_AUDPKT_N_2 0x3AD > + > +#define SOFT_DDC_TIMEOUT_MS 100 > + > +#define MAX_HDCP_DOWN_STREAM_COUNT 127 > +#define HDCP_SHA1_FIFO_LEN (MAX_HDCP_DOWN_STREAM_COUNT * DRM_HDCP_KSV_LEN + 10) > + > +#define HI_BYTE(x) (((x) >> 8) & 0xFF) > +#define LO_BYTE(x) ((x) & 0xFF) > + > +enum video_state { > + it61620_VIDEO_OFF = 0x00, > + it61620_VIDEO_WAIT, > + it61620_VIDEO_ON, > +}; > + > +enum hdcp_state { > + CP_NONE = 0x00, > + CP_GOING = 0x01, > +}; > + > +enum it61620_audio_select { > + I2S = 0, > + SPDIF, > +}; > + > +enum it61620_audio_word_length { > + WORD_LENGTH_16BIT = 0x0, > + WORD_LENGTH_18BIT = 0x1, > + WORD_LENGTH_20BIT = 0x2, > + WORD_LENGTH_24BIT = 0x3, > +}; > + > +enum it61620_audio_sample_rate { > + SAMPLE_RATE_32K = 0x3, > + SAMPLE_RATE_48K = 0x2, > + SAMPLE_RATE_64K = 0xB, > + SAMPLE_RATE_96K = 0xA, > + SAMPLE_RATE_192K = 0xE, > + SAMPLE_RATE_44_1K = 0x0, > + SAMPLE_RATE_88_2K = 0x8, > + SAMPLE_RATE_176_4K = 0xC, > +}; > + > +enum it61620_audio_type { > + LPCM = 0, > + NLPCM, > +}; > + > +struct it6162_chip_info { > + u16 vid; > + u16 pid; > +}; > + > +struct it61620_audio { > + enum it61620_audio_select select; > + enum it61620_audio_type type; > + enum it61620_audio_sample_rate sample_rate; > + u8 word_length; > + u8 channel_count; > + u8 audfmt; > + unsigned int audio_enable; > + unsigned int sample_width; > + unsigned int channel_number; > + u8 infoframe[HDMI_INFOFRAME_SIZE(AUDIO)]; > + unsigned char channel_status[AES_IEC958_STATUS_SIZE]; > +}; > + > +struct it61620_mipirx { > + u8 lane_num; > + u8 pn_swap; > + u8 lane_swap; > +}; > + > +struct it61620_hdmi_afe_setting { > + unsigned int clock; > + unsigned int h2on_pll; > + unsigned int hs; > + unsigned int afe_val[24]; > +}; > + > +struct it61620_platform_data { > + struct regulator *ovdd1833; > + struct regulator *ivdd; > + struct regulator *ovdd33; > + struct gpio_desc *gpiod_reset; > +}; > + > +struct it61620 { > + struct drm_bridge bridge; > + struct drm_connector connector; > + struct device *dev; > + enum drm_connector_status connector_status; > + struct drm_device *drm; > + struct drm_bridge *next_bridge; > + > + struct i2c_client *it61620_i2c; > + struct i2c_client *mipirx_i2c; > + struct i2c_client *tx_i2c; > + struct regmap *it61620_regmap; > + struct regmap *mipirx_regmap; > + struct regmap *tx_regmap; > + > + struct delayed_work hdcp_work; > + struct wait_queue_head wq; > + > + struct it61620_platform_data pdata; > + bool powered; > + bool is_hdmi; > + bool en_audio; > + bool hpd; > + u8 dev_ver; > + const struct drm_edid *cached_edid; > + > + /* operations can only be served one at the time */ > + struct mutex ddc_lock; > + > + enum video_state video_state; > + > + struct it61620_audio audio_config; > + > + /* it61620 DSI RX related params */ > + struct mipi_dsi_device *dsi; > + > + struct it61620_mipirx mipirx_config; > + > + struct videomode vm; > + > + struct i2c_adapter ddc; > + > + enum hdcp_state hdcp_state; > + u8 sha1_input[HDCP_SHA1_FIFO_LEN]; > + const struct it6162_chip_info *chip_info; > +}; > + > +static void it61620_show_drm_video_mode(struct it61620 *it61620, > + const struct videomode *vm); > +static void it61620_stop_hdcp_work(struct it61620 *it61620); > +static void it61620_start_hdcp_work(struct it61620 *it61620); > +static void it61620_hdmi_hdcp_wait_ksv_list(struct it61620 *it61620); > +static inline void it61620_hdmi_enable_avmute(struct it61620 *it61620, > + bool enable); > + > +static struct it61620 *bridge_to_it61620(struct drm_bridge *bridge) > +{ > + return container_of(bridge, struct it61620, bridge); > +} > + > +static const struct regmap_config it61620_regmap_config = { > + .reg_bits = 8, > + .val_bits = 8, > + .max_register = 0xff, > + .cache_type = REGCACHE_NONE, > +}; > + > +static const struct regmap_range it61620_tx_volatile_ranges[] = { > + { .range_min = 0, .range_max = 0x3ff}, > +}; > + > +static const struct regmap_access_table it61620_tx_volatile_table = { > + .yes_ranges = it61620_tx_volatile_ranges, > + .n_yes_ranges = ARRAY_SIZE(it61620_tx_volatile_ranges), > +}; > + > +static const struct regmap_range_cfg it61620_tx_regmap_ranges[] = { > + { > + .range_min = 0, > + .range_max = 0x3ff, > + .selector_reg = TX_REG_HDMITX_BANK, > + .selector_mask = M_HDMITX_BANK, > + .selector_shift = 0, > + .window_start = 0x00, > + .window_len = 0x100, > + }, > +}; > + > +static const struct regmap_config it61620_tx_regmap_config = { > + .reg_bits = 8, > + .val_bits = 8, > + .volatile_table = &it61620_tx_volatile_table, > + .ranges = it61620_tx_regmap_ranges, > + .num_ranges = ARRAY_SIZE(it61620_tx_regmap_ranges), > + .max_register = 0x3FF, > + .cache_type = REGCACHE_NONE, > +}; > + > +static const struct regmap_range it61620_mipirx_volatile_ranges[] = { > + { .range_min = 0, .range_max = 0x1ff }, > +}; > + > +static const struct regmap_access_table it61620_mipirx_volatile_table = { > + .yes_ranges = it61620_mipirx_volatile_ranges, > + .n_yes_ranges = ARRAY_SIZE(it61620_mipirx_volatile_ranges), > +}; > + > +static const struct regmap_range_cfg it61620_mipirx_regmap_ranges[] = { > + { > + .range_min = 0, > + .range_max = 0x1ff, > + .selector_reg = RX_REG_BANK, > + .selector_mask = M_MIPIRX_BANK, > + .selector_shift = 0, > + .window_start = 0x00, > + .window_len = 0x100, > + }, > +}; > + > +static const struct regmap_config it61620_mipi_regmap_config = { > + .reg_bits = 8, > + .val_bits = 8, > + .volatile_table = &it61620_mipirx_volatile_table, > + .ranges = it61620_mipirx_regmap_ranges, > + .num_ranges = ARRAY_SIZE(it61620_mipirx_regmap_ranges), > + .max_register = 0x1FF, > + .cache_type = REGCACHE_NONE, > +}; > + > +static unsigned int it61620_mipi_reg_read(struct it61620 *it61620, > + unsigned int reg) > +{ > + unsigned int val; > + int err; > + struct device *dev = it61620->dev; > + > + if (!it61620->powered) > + return -ENODEV; > + > + err = regmap_read(it61620->mipirx_regmap, reg, &val); > + if (err < 0) { > + dev_err(dev, "read failed rx reg[0x%x] err: %d", reg, err); > + return err; > + } > + > + return val; > +} > + > +static int it61620_mipi_reg_write(struct it61620 *it61620, unsigned int reg, > + unsigned int val) > +{ > + int err; > + struct device *dev = it61620->dev; > + > + if (!it61620->powered) > + return -ENODEV; > + > + err = regmap_write(it61620->mipirx_regmap, reg, val); > + > + if (err < 0) { > + dev_err(dev, "write failed rx reg[0x%x] = 0x%x err = %d", > + reg, val, err); > + return err; > + } > + > + return 0; > +} > + > +static int it61620_mipi_reg_set(struct it61620 *it61620, unsigned int reg, > + unsigned int mask, unsigned int val) > +{ > + int err; > + struct device *dev = it61620->dev; > + > + if (!it61620->powered) > + return -ENODEV; > + > + err = regmap_update_bits(it61620->mipirx_regmap, reg, mask, val); > + if (err < 0) { > + dev_err(dev, > + "write rx reg[0x%x] = 0x%x mask = 0x%x failed err %d", > + reg, val, mask, err); > + return err; > + } > + > + return 0; > +} > + > +static unsigned int it61620_hdmi_reg_read(struct it61620 *it61620, > + unsigned int reg) > +{ > + unsigned int val; > + int err; > + struct device *dev = it61620->dev; > + > + if (!it61620->powered) > + return -ENODEV; > + > + err = regmap_read(it61620->tx_regmap, reg, &val); > + if (err < 0) { > + dev_err(dev, "read failed tx reg[0x%x] err: %d", reg, err); > + return err; > + } > + > + return val; > +} > + > +static int it61620_hdmi_reg_write(struct it61620 *it61620, unsigned int reg, > + unsigned int val) > +{ > + int err; > + struct device *dev = it61620->dev; > + > + if (!it61620->powered) > + return -ENODEV; > + > + err = regmap_write(it61620->tx_regmap, reg, val); > + > + if (err < 0) { > + dev_err(dev, "write failed tx reg[0x%x] = 0x%x err = %d", > + reg, val, err); > + return err; > + } > + > + return 0; > +} > + > +static int it61620_hdmi_reg_set(struct it61620 *it61620, unsigned int reg, > + unsigned int mask, unsigned int val) > +{ > + int err; > + struct device *dev = it61620->dev; > + > + if (!it61620->powered) > + return -ENODEV; > + > + err = regmap_update_bits(it61620->tx_regmap, reg, mask, val); > + if (err < 0) { > + dev_err(dev, > + "write tx reg[0x%x] = 0x%x mask = 0x%x failed err %d", > + reg, val, mask, err); > + return err; > + } > + > + return 0; > +} > + > +static void it61620_mipi_reset_video(struct it61620 *it61620) > +{ > + it61620_mipi_reg_write(it61620, RX_REG_DSC_RESET, 0x38); > + usleep_range(100, 200); > + it61620_mipi_reg_set(it61620, RX_REG_D2P_RESET, 0x70, 0x70); > + it61620_mipi_reg_write(it61620, RX_REG_DSC_RESET, 0x00); > + > + it61620_mipi_reg_set(it61620, RX_REG_RESET_CTRL, 0x57, 0x00); > + usleep_range(1000, 2000); > +} > + > +static void it61620_mipi_m2p_reset(struct it61620 *it61620) > +{ > + if (it61620->dev_ver != DEV_VERSION_A0) > + return; > + it61620_mipi_reg_set(it61620, RX_REG_MIPI_CTRL02, B_FIFO_RST, > + B_FIFO_RST); > + usleep_range(1000, 2000); > + it61620_mipi_reg_set(it61620, RX_REG_MIPI_CTRL02, B_FIFO_RST, 0x00); > +} > + > +static void it61620_mipi_d2p_reset_fifo(struct it61620 *it61620) > +{ > + it61620_mipi_reg_set(it61620, RX_REG_D2P_RESET, 0x70, 0x70); > + usleep_range(1000, 2000); > + it61620_mipi_reg_set(it61620, RX_REG_D2P_RESET, 0x70, 0x50); > + usleep_range(100, 200); > + it61620_mipi_reg_set(it61620, RX_REG_D2P_RESET, 0x70, 0x10); > + usleep_range(100, 200); > + it61620_mipi_reg_set(it61620, RX_REG_D2P_RESET, 0x70, 0x00); > +} > + > +static void it61620_mipi_d2p_reset(struct it61620 *it61620) > +{ > + it61620_mipi_m2p_reset(it61620); > + it61620_mipi_reg_set(it61620, RX_REG_D_RST, B_D_RST, B_D_RST); > + usleep_range(1000, 2000); > + it61620_mipi_reg_set(it61620, RX_REG_D_RST, B_D_RST, 0x00); > + it61620_mipi_d2p_reset_fifo(it61620); > +} > + > +static void it61620_mipi_reset(struct it61620 *it61620) > +{ > + unsigned int val; > + u8 dev_ver = it61620->dev_ver; > + struct it61620_mipirx *mipirx = &it61620->mipirx_config; > + > + it61620_mipi_reg_set(it61620, RX_REG_RESET_CTRL, B_REF_CLOCK_RESET, > + B_REF_CLOCK_RESET); > + usleep_range(1000, 2000); > + it61620_mipi_reg_set(it61620, RX_REG_RESET_CTRL, B_REF_CLOCK_RESET, > + 0x00); > + usleep_range(1000, 2000); > + > + it61620_mipi_d2p_reset(it61620); > + > + it61620_mipi_reg_write(it61620, RX_REG_HS_CTRL, 0x93); > + it61620_mipi_reg_write(it61620, RX_REG_LP_CTRL, 0x0C); > + it61620_mipi_reg_write(it61620, RX_REG_AUTO_SYNC, 0x01); > + it61620_mipi_reg_write(it61620, RX_REG_MV_MAX, 0x0F); > + it61620_mipi_reg_write(it61620, RX_REG_FORCE_M, B_FORCE_MHT_STB); > + > + it61620_mipi_reg_write(it61620, RX_REG_MIPI_CTRL01, 0x2C); > + it61620_mipi_reg_write(it61620, RX_REG_AUTO_D2P_RESET, 0x13); > + it61620_mipi_reg_write(it61620, RX_REG_D2P_CTRL, 0x28); > + it61620_mipi_reg_write(it61620, RX_REG_TUNEOPT, 0x9C); > + > + it61620_mipi_reg_set(it61620, RX_REG_CLK_CTRL, 0x30, 0x20); > + > + if (dev_ver != DEV_VERSION_A0) { > + it61620_mipi_reg_write(it61620, RX_REG_TUNETHRE, 0x02); > + it61620_mipi_reg_write(it61620, RX_REG_AUTO_D2P_RESET, 0x83); > + it61620_mipi_reg_set(it61620, RX_REG_FORCE_M, B_FORCE_MVT_STB, > + B_FORCE_MVT_STB); > + it61620_mipi_reg_set(it61620, RX_REG_SYNC_NUM, 0xF7, 0x44); > + it61620_mipi_reg_set(it61620, RX_REG_BSP_SEL, 0x03, 0x02); > + it61620_mipi_reg_set(it61620, RX_REG_PWD_CTRL, 0x24, 0x24); > + it61620_mipi_reg_set(it61620, RX_REG_ENVRR, 0x01, 0x00); > + it61620_mipi_reg_write(it61620, RX_REG_ENVBLK, 0x00); > + it61620_mipi_reg_set(it61620, RX_REG_DSCCTRL, 0x40, 0x00); > + } > + val = (mipirx->lane_num - 1) | > + (mipirx->pn_swap ? B_MIPI_PN_SWAP : 0x00) | > + (mipirx->lane_swap ? B_MIPI_LANE_SWAP : 0x00); > + > + it61620_mipi_reg_set(it61620, RX_REG_MIPI_CONFIG, 0x0F, val); > + > + it61620_mipi_reset_video(it61620); > +} > + > +static void it61620_mipi_video_change_irq(struct it61620 *it61620) > +{ > + unsigned int reg22; > + unsigned int video_stable; > + > + reg22 = it61620_mipi_reg_read(it61620, RX_REG_INT_STATUS_02); > + video_stable = reg22 & B_INI_V_STB; > + > + if (video_stable) { > + it61620_mipi_m2p_reset(it61620); > + it61620_mipi_d2p_reset_fifo(it61620); > + } else { > + it61620_mipi_reg_set(it61620, RX_REG_D_RST, 0x01, 0x01); > + usleep_range(1000, 2000); > + it61620_mipi_reg_set(it61620, RX_REG_D_RST, 0x01, 0x00); > + it61620_mipi_reg_set(it61620, RX_REG_D2P_RESET, 0x70, 0x70); > + } > +} > + > +static void it61620_mipi_irq_handler(struct it61620 *it61620) > +{ > + unsigned int reg0a, reg_val; > + > + reg_val = it61620_mipi_reg_read(it61620, RX_REG_CLK_CTRL) & > + B_MIPI_INT_STATUS; > + if (reg_val == 0) > + return; > + > + reg0a = it61620_mipi_reg_read(it61620, RX_REG_INT_STATUS_01); > + it61620_mipi_reg_write(it61620, RX_REG_INT_STATUS_01, reg0a); > + if (reg0a & B_INI_V_CHG) > + it61620_mipi_video_change_irq(it61620); > +} > + > +static void it61620_mipi_set_d2v_video_timing(struct it61620 *it61620) > +{ > + u8 seldckval; > + u32 htotal, hfp, hsw, hbp, hdew; > + u32 vfp, vsw, vbp, vdew; > + u32 clock; > + bool hpol_high = 0, vpol_high = 0; > + struct videomode *vm = &it61620->vm; > + > + it61620_show_drm_video_mode(it61620, &it61620->vm); > + > + if (vm->flags & DISPLAY_FLAGS_HSYNC_HIGH) > + hpol_high = true; > + > + if (vm->flags & DISPLAY_FLAGS_VSYNC_HIGH) > + vpol_high = true; > + > + clock = vm->pixelclock / 1000; > + hdew = vm->hactive; > + > + hfp = vm->hfront_porch; > + hsw = vm->hsync_len; > + hbp = vm->hback_porch; > + htotal = vm->hactive + vm->hfront_porch + vm->hsync_len + > + vm->hback_porch; > + > + vdew = vm->vactive; > + vfp = vm->vfront_porch; > + vsw = vm->vsync_len; > + vbp = vm->vback_porch; > + > + if (it61620->dev_ver != DEV_VERSION_A0) { > + if (it61620->dev_ver == DEV_VERSION_C0) { > + seldckval = 0x04; > + } else { > + if (clock > 270000) > + seldckval = 0x0C; > + else > + seldckval = 0x18; > + } > + it61620_mipi_reg_set(it61620, RX_REG_SELDCLK, 0x1C, seldckval); > + } > + > + if (hdew > 2000) > + it61620_mipi_reg_write(it61620, RX_REG_DSC_VFRD, 0x50); > + else > + it61620_mipi_reg_write(it61620, RX_REG_DSC_VFRD, hdew / 36); > + > + it61620_mipi_reg_write(it61620, RX_REG_HFP_L, LO_BYTE(hfp)); > + it61620_mipi_reg_write(it61620, RX_REG_HFP_H, HI_BYTE(hfp)); > + > + it61620_mipi_reg_write(it61620, RX_REG_HSW_L, LO_BYTE(hsw)); > + it61620_mipi_reg_write(it61620, RX_REG_HSW_H, HI_BYTE(hsw)); > + > + it61620_mipi_reg_write(it61620, RX_REG_HBP_L, LO_BYTE(hbp)); > + it61620_mipi_reg_write(it61620, RX_REG_HBP_H, HI_BYTE(hbp)); > + > + it61620_mipi_reg_write(it61620, RX_REG_HDEW_L, LO_BYTE(hdew)); > + it61620_mipi_reg_write(it61620, RX_REG_HDEW_H, HI_BYTE(hdew)); > + > + it61620_mipi_reg_write(it61620, RX_REG_HTOTAL_L, LO_BYTE(htotal)); > + it61620_mipi_reg_write(it61620, RX_REG_HTOTAL_H, HI_BYTE(htotal)); > + > + it61620_mipi_reg_write(it61620, RX_REG_VFP_L, LO_BYTE(vfp)); > + it61620_mipi_reg_write(it61620, RX_REG_VFP_H, HI_BYTE(vfp)); > + > + it61620_mipi_reg_write(it61620, RX_REG_VSW_L, LO_BYTE(vsw)); > + it61620_mipi_reg_write(it61620, RX_REG_VSW_H, HI_BYTE(vsw)); > + > + it61620_mipi_reg_write(it61620, RX_REG_VBP_L, LO_BYTE(vbp)); > + it61620_mipi_reg_write(it61620, RX_REG_VBP_H, HI_BYTE(vbp)); > + > + it61620_mipi_reg_write(it61620, RX_REG_VDEW_L, LO_BYTE(vdew)); > + it61620_mipi_reg_write(it61620, RX_REG_VDEW_H, HI_BYTE(vdew)); > + > + it61620_mipi_reg_set(it61620, RX_REG_POL, 0x03, ((!vpol_high) << 1) | > + (!hpol_high)); > + > + if (it61620->dev_ver == DEV_VERSION_A0 && > + ((hdew == 2560 && vdew == 1440 && clock == 241500) || > + (hdew == 720 && vdew == 400 && clock == 28320) || > + (hdew == 720 && vdew == 576 && clock == 27000))) { Why are these modes special? How do we make sure we're not missing any modes that require extra operations? > + dev_dbg(it61620->dev, "device A0 %dx%d %d Khz", > + hdew, vdew, clock); > + it61620_mipi_reg_set(it61620, RX_REG_MPPCLKI, 0x80, 0x80); > + it61620_hdmi_reg_set(it61620, TX_REG_VH_TIME, 0x48, 0x48); > + > + it61620_hdmi_reg_write(it61620, TX_REG_PG_HFP_L, LO_BYTE(hfp)); > + it61620_hdmi_reg_write(it61620, TX_REG_PG_HFP_H, HI_BYTE(hfp)); > + > + it61620_hdmi_reg_write(it61620, TX_REG_PG_HSW_L, LO_BYTE(hsw)); > + it61620_hdmi_reg_write(it61620, TX_REG_PG_HSW_H, HI_BYTE(hsw)); > + > + it61620_hdmi_reg_write(it61620, TX_REG_PG_HBP_L, LO_BYTE(hbp)); > + it61620_hdmi_reg_write(it61620, TX_REG_PG_HBP_H, HI_BYTE(hbp)); > + > + it61620_hdmi_reg_write(it61620, TX_REG_PG_DEW_L, LO_BYTE(hdew)); > + it61620_hdmi_reg_write(it61620, TX_REG_PG_DEW_H, HI_BYTE(hdew)); > + > + it61620_hdmi_reg_write(it61620, TX_REG_PG_HVR2_L, 0xFF); > + it61620_hdmi_reg_write(it61620, TX_REG_PG_HVR2_H, 0x0F); > + > + it61620_hdmi_reg_write(it61620, TX_REG_PG_VFP_L, LO_BYTE(vfp)); > + it61620_hdmi_reg_write(it61620, TX_REG_PG_VFP_H, HI_BYTE(vfp)); > + > + it61620_hdmi_reg_write(it61620, TX_REG_PG_VSW_L, LO_BYTE(vsw)); > + it61620_hdmi_reg_write(it61620, TX_REG_PG_VSW_H, HI_BYTE(vsw)); > + > + it61620_hdmi_reg_write(it61620, TX_REG_PG_VBP_L, LO_BYTE(vbp)); > + it61620_hdmi_reg_write(it61620, TX_REG_PG_VBP_H, HI_BYTE(vbp)); > + > + it61620_hdmi_reg_write(it61620, TX_REG_PG_VDEW_L, LO_BYTE(vdew)); > + it61620_hdmi_reg_write(it61620, TX_REG_PG_HDEW_H, HI_BYTE(vdew)); > + > + it61620_hdmi_reg_write(it61620, TX_REG_PG_VFP2_L, 0xFF); > + it61620_hdmi_reg_write(it61620, TX_REG_PG_VFP2_H, 0x0F); > + > + it61620_hdmi_reg_set(it61620, TX_REG_PG_POL, 0x07, > + ((vpol_high) << 1) | (hpol_high)); > + > + } else { > + it61620_mipi_reg_set(it61620, RX_REG_MPPCLKI, 0x80, 0x00); > + it61620_hdmi_reg_set(it61620, TX_REG_VH_TIME, 0x48, 0x00); > + } > + > + it61620_mipi_d2p_reset(it61620); > +} > + > +static void it61620_hdmi_reset(struct it61620 *it61620) > +{ > + it61620_hdmi_reg_set(it61620, TX_REG_RESET_1_CTRL, 0x7E, 0x7E); > + it61620_hdmi_reg_set(it61620, TX_REG_RESET_2_CTRL, 0x36, 0x36); > + usleep_range(1000, 2000); > + > + it61620_hdmi_reg_set(it61620, TX_REG_RESET_1_CTRL, 0x1F, 0x00); > + usleep_range(1000, 2000); > + it61620_hdmi_reg_set(it61620, TX_REG_RESET_1_CTRL, 0x40, 0x00); > + > + it61620_hdmi_reg_write(it61620, TX_REG_RDROM_TRG, 0x04); > + usleep_range(1000, 2000); > + > + it61620_hdmi_reg_set(it61620, TX_REG_SYS_CONFIG, B_EN_HDMI, B_EN_HDMI); > + > + /* Reset AFE */ > + it61620_hdmi_reg_set(it61620, TX_REG_XLC_7_CTRL, 0x04, 0x00); > + it61620_hdmi_reg_set(it61620, TX_REG_IPLL_CTRL, 0x02, 0x00); > + it61620_hdmi_reg_set(it61620, TX_REG_TXPLL_CTRL, 0x04, 0x00); > + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_CTRL, 0x01, 0x00); > + > + it61620_hdmi_reg_set(it61620, TX_REG_XLC_7_CTRL, 0x04, 0x04); > + it61620_hdmi_reg_set(it61620, TX_REG_IPLL_CTRL, 0x02, 0x02); > + it61620_hdmi_reg_set(it61620, TX_REG_TXPLL_CTRL, 0x04, 0x04); > + > + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_CTRL, 0x01, 0x01); > + > + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_CTRL, 0x08, 0x08); > + > + it61620_hdmi_reg_write(it61620, TX_REG_V_QUEUE, 0x08); > + it61620_hdmi_reg_write(it61620, TX_REG_V_TU, 0x07); > + > + it61620_hdmi_reg_write(it61620, TX_REG_CR_1_CTRL, 0x09); > + > + it61620_hdmi_reg_write(it61620, TX_REG_CR_2_CTRL, 0x16); > + > + it61620_hdmi_reg_write(it61620, TX_REG_VD_CTRL1, 0x04); > + > + it61620_hdmi_reg_write(it61620, TX_REG_HDCP_CTRL2, 0x04); > + > + it61620_hdmi_reg_write(it61620, TX_REG_VD_CTRL3, 0x84); > + it61620_hdmi_reg_write(it61620, TX_REG_HPD_CONFIG, 0x06); > + usleep_range(1000, 2000); > + > + it61620_hdmi_reg_write(it61620, TX_REG_VD_CTRL2, 0x2E); > + it61620_hdmi_reg_write(it61620, TX_REG_HDMI_CTRL1, 0x30); > + > + it61620_hdmi_reg_write(it61620, TX_REG_HDMI_CTRL2, 0x04); > +} > + > +static void it61620_hdmi_poweron(struct it61620 *it61620) > +{ > + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_PD_CTRL, 0x70, 0x00); > + > + it61620_hdmi_reg_set(it61620, TX_REG_XLC_7_CTRL, 0x07, 0x06); > + it61620_hdmi_reg_set(it61620, TX_REG_IPLL_CTRL, 0x12, 0x12); > + it61620_hdmi_reg_set(it61620, TX_REG_TXPLL_CTRL, 0xc6, 0x84); > + it61620_hdmi_reg_set(it61620, TX_REG_SSC_PD, 0x03, 0x03); > + > + it61620_hdmi_reg_set(it61620, TX_REG_CLOCK_PWD_CTRL, 0x0F, 0x00); > + it61620_hdmi_reg_set(it61620, TX_REG_VD_CTRL2, B_VIDEO_FIFO_REST, > + B_VIDEO_FIFO_REST); > + usleep_range(1000, 2000); > + it61620_hdmi_reg_set(it61620, TX_REG_VD_CTRL2, B_VIDEO_FIFO_REST, 0x00); > +} > + > +static void it61620_hdmi_powerdown(struct it61620 *it61620) > +{ > + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_PD_CTRL, 0x70, 0x70); > + > + it61620_hdmi_reg_set(it61620, TX_REG_SSC_PD, 0x03, 0x00); > + it61620_hdmi_reg_set(it61620, TX_REG_IPLL_CTRL, 0x12, 0x00); > + it61620_hdmi_reg_set(it61620, TX_REG_TXPLL_CTRL, 0xc6, 0xc2); > + it61620_hdmi_reg_set(it61620, TX_REG_XLC_7_CTRL, 0x07, 0x01); > + > + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_CTRL, 0xf9, 0x00); > + it61620_hdmi_reg_set(it61620, TX_REG_AUX_CTRL, 0x90, 0x00); > + > + it61620_hdmi_reg_set(it61620, TX_REG_CLOCK_PWD_CTRL, 0x0F, 0x0a); > + it61620_hdmi_reg_set(it61620, TX_REG_CEC_CONFIG, B_EN_CEC, 0x00); > +} > + > +static bool it61620_hdmi_get_hpd_status(struct it61620 *it61620) > +{ > + int val; > + > + val = it61620_hdmi_reg_read(it61620, TX_REG_STATUS01); > + if (val < 0) > + return false; > + > + return !!(val & B_HPD_STATUS); > +} > + > +static void it61620_hdmi_ddc_abort(struct it61620 *it61620) > +{ > + struct drm_device *drm = it61620->drm; > + > + it61620_hdmi_reg_set(it61620, TX_REG_DDC_CTRL2, B_DDC_REST, B_DDC_REST); > + usleep_range(1000, 2000); > + it61620_hdmi_reg_set(it61620, TX_REG_DDC_CTRL2, B_DDC_REST, 0x00); > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, DDC_COMMAND_ABORT); > + usleep_range(1000, 2000); > + drm_dbg(drm, "tx ddc ststus %02X\n", > + it61620_hdmi_reg_read(it61620, TX_REG_DDC_STATUS)); > +} > + > +static int it61620_hdmi_ddc_wait(struct it61620 *it61620) > +{ > + struct drm_device *drm = it61620->drm; > + unsigned int ddc_status; > + int ret = 0; > + unsigned long timeout; > + > + timeout = jiffies + msecs_to_jiffies(SOFT_DDC_TIMEOUT_MS) + 1; > + > + for (;;) { > + usleep_range(1000, 2000); > + ddc_status = it61620_hdmi_reg_read(it61620, TX_REG_DDC_STATUS); > + > + if (ddc_status & B_DDC_NOACK) { > + drm_dbg(drm, "DDC no ack"); > + ret = -EIO; > + break; > + } > + > + if (ddc_status & B_DDC_TX_DONE) > + break; > + > + if (ddc_status & B_DDC_FULL) { > + drm_dbg(drm, "DDC FULL"); > + break; > + } > + > + if (time_after(jiffies, timeout)) { > + drm_dbg(drm, "DDC SOFT timeout %x\n", ddc_status); > + ret = -ETIMEDOUT; > + break; > + } > + } > + > + return ret; > +} Can we re-write this function with readx_poll_timeout() or regmap_read_poll_timeout()? To use readx_poll_timeout(), you might need to introduce a dedicated function for reading TX_REG_DDC_STATUS. anx7625.c has some example usages with this. To use regmap_read_poll_timeout(), you will have to handle the checked in it61620_hdmi_reg_read() here. > + > +static int it61620_hdmi_get_ddc_fifo(struct it61620 *it61620, u8 *buf, > + size_t len) > +{ > + int err; > + struct device *dev = it61620->dev; > + > + if (!it61620->powered) > + return -ENODEV; > + > + err = regmap_bulk_read(it61620->tx_regmap, TX_REG_DDC_FIFO, buf, len); > + if (err < 0) { > + dev_err(dev, "read ddc fifo failed tx reg[0x%x] err = %d", > + TX_REG_DDC_FIFO, err); > + return err; > + } > + > + return 0; > +} > + > +static int it61620_hdmi_set_ddc_fifo(struct it61620 *it61620, u8 *buf, > + size_t len) > +{ > + int err; > + struct device *dev = it61620->dev; > + > + if (!it61620->powered) > + return -ENODEV; > + > + err = regmap_bulk_write(it61620->tx_regmap, TX_REG_DDC_FIFO, buf, len); > + if (err < 0) { > + dev_err(dev, "write ddc fifo failed tx reg[0x%x] err = %d", > + TX_REG_DDC_FIFO, err); > + return err; > + } > + > + return 0; > +} > + > +static const struct it61620_hdmi_afe_setting hdmi_afe[4] = { > + {375000, 0x01, 0x02, > + {0x03, 0x53, 0x1A, 0x03, 0x00, 0x04, > + 0x03, 0x53, 0x1A, 0x03, 0x00, 0x04, > + 0x03, 0x53, 0x1A, 0x03, 0x00, 0x04, > + 0x01, 0x4B, 0x0F, 0x00, 0x07, 0x04}}, > + {340000, 0x01, 0x02, > + {0x03, 0x53, 0x1A, 0x03, 0x00, 0x04, > + 0x03, 0x53, 0x1A, 0x03, 0x00, 0x04, > + 0x03, 0x53, 0x1A, 0x03, 0x00, 0x04, > + 0x01, 0x4B, 0x0F, 0x00, 0x07, 0x04}}, > + {150000, 0x00, 0x00, > + {0x03, 0x43, 0x18, 0x03, 0x00, 0x04, > + 0x03, 0x43, 0x18, 0x03, 0x00, 0x04, > + 0x03, 0x43, 0x18, 0x03, 0x00, 0x04, > + 0x03, 0x43, 0x18, 0x03, 0x00, 0x04}}, > + {0, 0x00, 0x00, > + {0x03, 0x43, 0x18, 0x03, 0x00, 0x04, > + 0x03, 0x43, 0x18, 0x03, 0x00, 0x04, > + 0x03, 0x43, 0x18, 0x03, 0x00, 0x04, > + 0x03, 0x43, 0x18, 0x03, 0x00, 0x04}} > +}; > + > +static void it61620_hdmi_setup_afe(struct it61620 *it61620, int clock) > +{ > + int i; > + unsigned int reg_ofset; > + const struct it61620_hdmi_afe_setting *afe; > + > + it61620_hdmi_reg_set(it61620, TX_REG_AFE30, 0x1F, 0x07); > + it61620_hdmi_reg_write(it61620, TX_REG_AFEE9, 0x10); > + it61620_hdmi_reg_write(it61620, TX_REG_AFE33, 0x00); > + it61620_hdmi_reg_write(it61620, TX_REG_AFE34, 0xE4); > + > + it61620_hdmi_reg_write(it61620, TX_REG_AFE35, 0x00); > + it61620_hdmi_reg_write(it61620, TX_REG_AFEE9, 0x10); > + > + for (i = 0; i < sizeof(hdmi_afe); i++) { > + if (clock > hdmi_afe[i].clock || hdmi_afe[i].clock == 0) > + break; > + } > + > + afe = &hdmi_afe[i]; > + > + it61620_hdmi_reg_write(it61620, TX_REG_AFE0E, 0xF0); > + > + if (clock > 100000) > + it61620_hdmi_reg_set(it61620, TX_REG_TXPLL_CTRL, 0x19, 0x08); > + else > + it61620_hdmi_reg_set(it61620, TX_REG_TXPLL_CTRL, 0x19, 0x11); > + > + if (afe->h2on_pll) { > + it61620_hdmi_reg_write(it61620, TX_REG_AFE_XP, 0x48); > + it61620_hdmi_reg_set(it61620, TX_REG_AFE_XLC1, 0x87, 0x81); > + it61620_hdmi_reg_set(it61620, TX_REG_AFE_XLC2, 0x40, 0x00); > + it61620_hdmi_reg_write(it61620, TX_REG_AFE_XLC3, 0x32); > + it61620_hdmi_reg_set(it61620, TX_REG_XLC_7_CTRL, 0xFF, 0xB6); > + } else { > + it61620_hdmi_reg_write(it61620, TX_REG_AFE_XP, 0x00); > + } > + > + it61620_hdmi_reg_write(it61620, TX_REG_AFE_DRV, 0x00); > + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_CTRL, 0x02, afe->hs); > + > + for (i = 0, reg_ofset = 0x280; reg_ofset <= 0x297; reg_ofset++) > + it61620_hdmi_reg_write(it61620, reg_ofset, afe->afe_val[i++]); > + > + it61620_hdmi_reg_set(it61620, TX_REG_INT_MASK3, B_TMDS_STB_CHG, > + B_TMDS_STB_CHG); > +} > + > +static inline void it61620_hdmi_fire_afe(struct it61620 *it61620) > +{ > + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_CTRL, 0xF1, 0xF1); > +} > + > +static inline void it61620_hdmi_disable_afe(struct it61620 *it61620) > +{ > + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_CTRL, 0xF1, 0x00); > +} > + > +static int it61620_hdmi_hdcprd(struct it61620 *it61620, int offset, int bytenum) > +{ > + int ret = 0; > + > + guard(mutex)(&it61620->ddc_lock); > + > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, > + DDC_COMMAND_FIFO_CLR); > + usleep_range(1000, 2000); > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_ADDR, DDC_HDCP_ADDR); > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_OFFSET, offset); > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_NUM_L, bytenum); > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_NUM_H, (bytenum & 0x300) >> 8); > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, DDC_COMMAND_BURST_R); > + > + if (it61620_hdmi_ddc_wait(it61620) < 0) { > + it61620_hdmi_ddc_abort(it61620); > + ret = -EIO; > + dev_dbg(it61620->dev, "ddc fail"); > + } > + return ret; > +} > + > +static int it61620_hdmi_hdcp_ksvlist_rd(struct it61620 *it61620, > + unsigned int bytenum, u8 *out) > +{ > + int ret = 0; > + unsigned int i; > + unsigned int count; > + > + guard(mutex)(&it61620->ddc_lock); > + > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, DDC_COMMAND_FIFO_CLR); > + usleep_range(1000, 2000); > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_ADDR, DDC_HDCP_ADDR); > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_OFFSET, 0x43); > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_NUM_L, bytenum); > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_NUM_H, (bytenum & 0x300) >> 8); > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, DDC_COMMAND_BURST_R); > + > + for (i = 0; i < bytenum;) { > + if (it61620_hdmi_ddc_wait(it61620) < 0) { > + it61620_hdmi_ddc_abort(it61620); > + ret = -EIO; > + dev_dbg(it61620->dev, "ddc fail"); > + break; > + } > + > + count = it61620_hdmi_reg_read(it61620, TX_REG_DDC_FIFO_STS) & > + M_DDC_STAGE_NUM; > + it61620_hdmi_get_ddc_fifo(it61620, (out + i), count); > + i += count; > + } > + > + return ret; > +} > + > +static int it61620_hdmi_enable_hdcp(struct it61620 *it61620) > +{ > + struct drm_device *drm = it61620->drm; > + unsigned int sts, auth_cs; > + > + sts = it61620_hdmi_reg_read(it61620, TX_REG_V_STS); > + if ((sts & B_TMDS_STABLE) != B_TMDS_STABLE) { > + drm_dbg(drm, "TMDS not stable, stop hdcp %x", sts); > + return false; > + } > + > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL3, B_ENC_DIS, B_ENC_DIS); > + usleep_range(1000, 2000); > + > + it61620_hdmi_reg_set(it61620, TX_REG_RESET_2_CTRL, 0x10, 0x10); > + usleep_range(1000, 2000); > + it61620_hdmi_reg_set(it61620, TX_REG_RESET_2_CTRL, 0x10, 0x00); > + > + it61620_hdmi_reg_set(it61620, TX_REG_R0TM, 0xC0, 0x40); > + it61620_hdmi_reg_write(it61620, TX_REG_SHA_SEL, 0x00); > + > + it61620_hdmi_reg_write(it61620, TX_REG_AUTOMUTE, 0x00); > + > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL2, B_AN_SEL, B_AN_SEL); > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL2, B_EN_AN_GEN, > + B_EN_AN_GEN); > + usleep_range(1000, 2000); > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL2, B_EN_AN_GEN, 0x00); > + > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL1, B_CPDESIRED, > + B_CPDESIRED); > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL3, (B_PAUSE | B_ENC_DIS), > + 0x00); > + > + it61620_hdmi_reg_write(it61620, TX_REG_HDCP_PRO, B_AUTH_FIRE); > + > + /* > + * HDCP start requires 100ms for the first part of the authentication > + * protocol,20ms is used to wait for 61620 HW completion. > + */ > + if (wait_event_timeout(it61620->wq, !it61620->hpd, msecs_to_jiffies(120))) > + return false; > + > + auth_cs = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_AUTH_CS) & M_AUTH_CH; > + if (auth_cs == CS_KSVLIST_CHK) { > + it61620_hdmi_hdcp_wait_ksv_list(it61620); > + usleep_range(1000, 2000); > + auth_cs = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_AUTH_CS) & > + M_AUTH_CH; > + } > + > + if (auth_cs == CS_AUTH_DONE) { > + it61620_hdmi_enable_avmute(it61620, false); > + it61620_hdmi_reg_set(it61620, TX_REG_INT1, B_INT_AUTH_F, > + B_INT_AUTH_F); > + it61620_hdmi_reg_set(it61620, TX_REG_INT_MASK1, B_INT_AUTH_F, > + B_INT_AUTH_F); > + drm_dbg(drm, "auth done"); > + return true; > + } > + > + drm_dbg(drm, "auth fail"); > + it61620_hdmi_enable_avmute(it61620, true); > + return false; > +} > + > +static void it61620_hdmi_reset_hdcp(struct it61620 *it61620) > +{ > + it61620_hdmi_reg_set(it61620, TX_REG_INT_MASK1, > + (B_INT_AUTH_D | B_INT_AUTH_F), 0x00); > + it61620_hdmi_reg_set(it61620, TX_REG_INT_MASK2, B_KSV_CHECK, 0x00); > + > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL3, B_ENC_DIS, B_ENC_DIS); > + usleep_range(1000, 2000); > + > + it61620_hdmi_reg_set(it61620, TX_REG_RESET_2_CTRL, 0x18, 0x18); > + usleep_range(1000, 2000); > + it61620_hdmi_reg_set(it61620, TX_REG_RESET_2_CTRL, 0x18, 0x00); > + > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL1, B_CPDESIRED, > + B_CPDESIRED); > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL3, > + (B_PAUSE | B_ENC_DIS), B_PAUSE); > + it61620_hdmi_reg_write(it61620, TX_REG_AUTOMUTE, 0x00); > +} > + > +static bool it61620_hdmi_hdcp_is_ksv_valid(u8 *ksv) > +{ > + int i, ones = 0; > + > + if ((ksv[4] == 0x93 && ksv[3] == 0x43 && ksv[2] == 0x5C && > + ksv[1] == 0xDE && ksv[0] == 0x23) || > + (ksv[4] == 0x7D && ksv[3] == 0xB4 && ksv[2] == 0x21 && > + ksv[1] == 0x37 && ksv[0] == 0x0B)) > + return false; > + > + /* KSV has 20 1's and 20 0's */ > + for (i = 0; i < 5; i++) > + ones += hweight8(ksv[i]); > + > + return ones == 20; > +} > + > +static void it61620_hdmi_disable_hdcp(struct it61620 *it61620) > +{ > + it61620_hdmi_reset_hdcp(it61620); > +} > + > +static int it61620_hdmi_start_hdcp(struct it61620 *it61620) > +{ > + struct drm_device *drm = it61620->drm; > + u8 rx_hdmi_mode; > + u8 bksv[DRM_HDCP_KSV_LEN]; > + bool retcheck; > + > + if (it61620_hdmi_hdcprd(it61620, DRM_HDCP_DDC_BSTATUS, > + DRM_HDCP_BSTATUS_LEN) < 0) { > + drm_dbg(drm, "read bstatus fail!\n"); > + return false; > + } > + > + rx_hdmi_mode = (it61620_hdmi_reg_read(it61620, 0x7E) & 0x10) >> 4; > + if (it61620->is_hdmi != rx_hdmi_mode) > + return false; > + > + it61620_hdmi_hdcprd(it61620, DRM_HDCP_DDC_BKSV, DRM_HDCP_KSV_LEN); > + bksv[0] = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_BKSV1); > + bksv[1] = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_BKSV2); > + bksv[2] = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_BKSV3); > + bksv[3] = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_BKSV4); > + bksv[4] = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_BKSV5); > + retcheck = it61620_hdmi_hdcp_is_ksv_valid(bksv); > + if (!retcheck) { > + drm_dbg(drm, "ksv valid!\n"); > + return false; > + } > + > + if (drm_hdcp_check_ksvs_revoked(drm, bksv, 1) > 0) > + return false; > + > + return it61620_hdmi_enable_hdcp(it61620); > +} > + > +static int it61620_hdmi_sha1_digest(struct it61620 *it61620, u8 *sha1_input, > + unsigned int size, u8 *output_av) > +{ > + struct shash_desc *desc; > + struct crypto_shash *tfm; > + int err; > + struct drm_device *drm = it61620->drm; > + > + tfm = crypto_alloc_shash("sha1", 0, 0); > + if (IS_ERR(tfm)) { > + drm_dbg(drm, "crypto_alloc_shash sha1 failed"); > + return PTR_ERR(tfm); > + } > + desc = kzalloc(sizeof(*desc) + crypto_shash_descsize(tfm), GFP_KERNEL); > + if (!desc) { > + crypto_free_shash(tfm); > + return -ENOMEM; > + } > + > + desc->tfm = tfm; > + err = crypto_shash_digest(desc, sha1_input, size, output_av); > + if (err) > + drm_dbg(drm, "crypto_shash_digest sha1 failed"); > + > + crypto_free_shash(tfm); > + kfree(desc); > + return err; > +} > + > +static int it61620_hdmi_setup_sha1_input(struct it61620 *it61620, u8 *input) > +{ > + struct drm_device *drm = it61620->drm; > + u8 bstatus[2]; > + int down_stream_count, i, count = 0; > + > + it61620_hdmi_hdcprd(it61620, DRM_HDCP_DDC_BSTATUS, DRM_HDCP_BSTATUS_LEN); > + bstatus[0] = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_BSTS_L); > + bstatus[1] = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_BSTS_H); > + > + down_stream_count = DRM_HDCP_NUM_DOWNSTREAM(bstatus[0]); > + if (DRM_HDCP_MAX_DEVICE_EXCEEDED(bstatus[0]) || > + DRM_HDCP_MAX_CASCADE_EXCEEDED(bstatus[1])) { > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL3, > + (B_PAUSE | B_ENC_DIS), B_PAUSE); > + return 0; > + } > + > + if (!down_stream_count || > + down_stream_count > MAX_HDCP_DOWN_STREAM_COUNT) { > + drm_dbg(drm, "HDCP down stream count Error %d", > + down_stream_count); > + return 0; > + } > + drm_dbg(drm, "down stream count %d\n", down_stream_count); > + > + count = down_stream_count * DRM_HDCP_KSV_LEN; > + it61620_hdmi_hdcp_ksvlist_rd(it61620, count, input); > + if (drm_hdcp_check_ksvs_revoked(drm, input, down_stream_count) > 0) > + return 0; > + > + input[count++] = bstatus[0]; > + input[count++] = bstatus[1]; > + > + it61620_hdmi_reg_set(it61620, TX_REG_SHA_SEL, 0x70, 0x70); > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL2, B_EN_M0_RD, B_EN_M0_RD); > + for (i = 0; i < 8; i++) > + input[count++] = it61620_hdmi_reg_read(it61620, > + (TX_REG_ANM0V1 + i)); > + > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL2, B_EN_M0_RD, 0x00); > + > + return count; > +} > + > +static bool it61620_hdmi_hdcp_part2_ksvlist_check(struct it61620 *it61620) > +{ > + struct drm_device *drm = it61620->drm; > + u8 av[5][4], bv[5][4]; > + int i, j; > + > + i = it61620_hdmi_setup_sha1_input(it61620, it61620->sha1_input); > + if (i <= 0) > + return false; > + > + it61620_hdmi_sha1_digest(it61620, it61620->sha1_input, i, (u8 *)av); > + > + for (i = 0; i < DRM_HDCP_V_PRIME_NUM_PARTS; i++) { > + it61620_hdmi_hdcprd(it61620, DRM_HDCP_DDC_V_PRIME(i), > + DRM_HDCP_V_PRIME_PART_LEN); > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL2, > + B_EN_M0_RD, B_EN_M0_RD); > + it61620_hdmi_reg_set(it61620, TX_REG_SHA_SEL, 0x70, (i << 4)); > + > + for (j = 0; j < DRM_HDCP_V_PRIME_PART_LEN; j++) > + bv[i][j] = it61620_hdmi_reg_read(it61620, > + TX_REG_ANM0V1 + j); > + } > + > + for (i = 0; i < DRM_HDCP_V_PRIME_NUM_PARTS; i++) > + if (bv[i][3] != av[i][0] || bv[i][2] != av[i][1] || > + bv[i][1] != av[i][2] || bv[i][0] != av[i][3]) > + break; > + > + if (i == DRM_HDCP_V_PRIME_NUM_PARTS) > + return true; > + > + drm_dbg(drm, "V' Not match!!"); > + return false; > +} > + > +static void it61620_hdmi_hdcp_wait_ksv_list(struct it61620 *it61620) > +{ > + u8 bcaps = 0; > + unsigned long timeout; > + > + timeout = jiffies + msecs_to_jiffies(5000) + 1; > + for (;;) { > + usleep_range(1000, 2000); > + it61620_hdmi_hdcprd(it61620, DRM_HDCP_DDC_BCAPS, 1); > + bcaps = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_BCAPS); > + if (bcaps & B_KSV_READY) > + break; > + > + if (it61620->hdcp_state != CP_GOING) > + break; > + > + if (time_after(jiffies, timeout)) > + break; > + } > + > + if ((bcaps & B_KSV_READY) && > + it61620_hdmi_hdcp_part2_ksvlist_check(it61620)) { > + it61620_hdmi_reg_write(it61620, TX_REG_HDCP_PRO, > + B_LIST_CHK_DONE); > + return; > + } > + it61620_hdmi_reg_write(it61620, TX_REG_HDCP_PRO, > + B_LIST_CHK_DONE | B_LIST_CHK_FAIL); > +} > + > +static void it61620_remove_edid(struct it61620 *it61620) > +{ > + drm_edid_free(it61620->cached_edid); > + it61620->cached_edid = NULL; > +} > + > +static void it61620_hdmi_irq_hdcp_auth_fail(struct it61620 *it61620) > +{ > + struct drm_device *drm = it61620->drm; > + > + if (it61620->hdcp_state == CP_GOING) { > + it61620_hdmi_enable_avmute(it61620, true); > + drm_dbg(drm, "auth fail after done, set avmute"); > + it61620_start_hdcp_work(it61620); > + } > +} > + > +static void it61620_hdmi_irq_hpd(struct it61620 *it61620) > +{ > + it61620->hpd = it61620_hdmi_get_hpd_status(it61620); > + > + if (!it61620->hpd) { > + wake_up(&it61620->wq); > + it61620_stop_hdcp_work(it61620); > + it61620_hdmi_disable_afe(it61620); > + it61620_remove_edid(it61620); > + } else if (it61620->video_state == it61620_VIDEO_ON) { > + it61620_hdmi_fire_afe(it61620); > + it61620_start_hdcp_work(it61620); > + } > +} > + > +static void it61620_hdmi_irq_rxsen_chg(struct it61620 *it61620) > +{ > + unsigned int rxsen; > + > + if (!it61620_hdmi_get_hpd_status(it61620)) > + return; > + > + rxsen = it61620_hdmi_reg_read(it61620, TX_REG_V_STS) & B_RXSEN; > + if (it61620->video_state == it61620_VIDEO_ON) { > + if (rxsen) { > + it61620_hdmi_fire_afe(it61620); > + it61620_start_hdcp_work(it61620); > + } else { > + it61620_stop_hdcp_work(it61620); > + it61620_hdmi_disable_afe(it61620); > + } > + } > +} > + > +static void it61620_hdmi_irq_TMDS_stb_change(struct it61620 *it61620) > +{ > + unsigned int video_status; > + > + video_status = it61620_hdmi_reg_read(it61620, TX_REG_V_STS); > + > + if (video_status & B_TMDS_STABLE) > + it61620_start_hdcp_work(it61620); > +} > + > +static bool it61620_test_bit(unsigned int bit, const unsigned int *addr) > +{ > + return 1 & (addr[bit / BITS_PER_BYTE] >> (bit % BITS_PER_BYTE)); > +} > + > +static void it61620_hdmi_interrupt_handler(struct it61620 *it61620) > +{ > + unsigned int int_status[3], i; > + static const struct { > + int bit; > + void (*handler)(struct it61620 *it61620); > + } irq_vec[] = { > + { BIT_HPD_CHG, it61620_hdmi_irq_hpd }, > + { BIT_RXSEN_CHANGE, it61620_hdmi_irq_rxsen_chg }, > + { BIT_INT_AUTH_F, it61620_hdmi_irq_hdcp_auth_fail }, > + { BIT_TMDS_STB_CHG, it61620_hdmi_irq_TMDS_stb_change }, > + }; > + > + int_status[0] = it61620_hdmi_reg_read(it61620, TX_REG_INT1); > + int_status[1] = it61620_hdmi_reg_read(it61620, TX_REG_INT2); > + int_status[2] = it61620_hdmi_reg_read(it61620, TX_REG_INT3); > + > + it61620_hdmi_reg_write(it61620, TX_REG_INT1, int_status[0]); > + it61620_hdmi_reg_write(it61620, TX_REG_INT2, int_status[1]); > + it61620_hdmi_reg_write(it61620, TX_REG_INT3, int_status[2]); > + > + for (i = 0; i < ARRAY_SIZE(irq_vec); i++) { > + if (it61620_test_bit(irq_vec[i].bit, (unsigned int *)int_status)) > + irq_vec[i].handler(it61620); > + } > +} > + > +static void it61620_hdmi_irq(struct it61620 *it61620) > +{ > + unsigned int reg_val; > + > + reg_val = it61620_hdmi_reg_read(it61620, TX_REG_HDMITX_BANK); > + if (reg_val & B_INT_EVENT_HDMI) > + it61620_hdmi_interrupt_handler(it61620); > +} > + > +static void it61620_hdmi_audio_set_ncts(struct it61620 *it61620, > + unsigned int sample_rate) > +{ > + unsigned int n, cts; > + > + drm_hdmi_acr_get_n_cts(it61620->vm.pixelclock, sample_rate, &n, &cts); > + > + it61620_hdmi_reg_write(it61620, TX_REG_AUDPKT_N_0, (u8)((n) & 0xFF)); > + it61620_hdmi_reg_write(it61620, TX_REG_AUDPKT_N_1, > + (u8)((n >> 8) & 0xFF)); > + it61620_hdmi_reg_write(it61620, TX_REG_AUDPKT_N_2, > + (u8)((n >> 16) & 0x0F)); > + > + it61620_hdmi_reg_write(it61620, TX_REG_AUDPKT_CTS_0, (u8)((cts) & 0xFF)); > + it61620_hdmi_reg_write(it61620, TX_REG_AUDPKT_CTS_1, > + (u8)((cts >> 8) & 0xFF)); > + it61620_hdmi_reg_write(it61620, TX_REG_AUDPKT_CTS_2, > + (u8)((cts >> 16) & 0x0F)); > +} > + > +static inline void it61620_hdmi_disable_audio_infoframe(struct it61620 *it61620) > +{ > + it61620_hdmi_reg_set(it61620, TX_REG_EN_PKT1, > + (B_EN_AUD | B_EN_AUD_RP), 0x00); > +} > + > +static inline void it61620_hdmi_enable_audio_infoframe(struct it61620 *it61620) > +{ > + it61620_hdmi_reg_set(it61620, TX_REG_EN_PKT1, (B_EN_AUD | B_EN_AUD_RP), > + (B_EN_AUD | B_EN_AUD_RP)); > +} > + > +static inline void it61620_hdmi_disable_avi_infoframe(struct it61620 *it61620) > +{ > + it61620_hdmi_reg_set(it61620, TX_REG_EN_PKT1, > + (B_EN_AVI | B_AVI_RP), 0x00); > +} > + > +static inline void it61620_hdmi_enable_avi_infoframe(struct it61620 *it61620) > +{ > + it61620_hdmi_reg_set(it61620, TX_REG_EN_PKT1, (B_EN_AVI | B_AVI_RP), > + (B_EN_AVI | B_AVI_RP)); > +} > + > +static inline void it61620_hdmi_enable_hdmi_mode(struct it61620 *it61620) > +{ > + it61620_hdmi_reg_set(it61620, TX_REG_HDMI_CTRL1, B_EN_HDMI_MODE, > + B_EN_HDMI_MODE); > +} > + > +static inline void it61620_hdmi_enable_DVI_mode(struct it61620 *it61620) > +{ > + it61620_hdmi_reg_set(it61620, TX_REG_HDMI_CTRL1, B_EN_HDMI_MODE, 0x00); > +} > + > +static inline void it61620_hdmi_enable_avmute(struct it61620 *it61620, > + bool enable) > +{ > + it61620_hdmi_reg_set(it61620, TX_REG_HDMI_CTRL2, B_EN_AVMUTE, enable); > +} > + > +static void it61620_hdmi_avi_infoframe_set(struct it61620 *it61620, > + const u8 *buffer, size_t len) > +{ > + struct drm_device *drm = it61620->drm; > + const u8 *ptr; > + u8 i; > + > + drm_dbg(drm, "avinfo set\n"); > + it61620_hdmi_disable_avi_infoframe(it61620); > + > + it61620_hdmi_enable_hdmi_mode(it61620); > + /* fill PB */ > + ptr = buffer + HDMI_INFOFRAME_HEADER_SIZE; > + for (i = 0; i < len - HDMI_INFOFRAME_HEADER_SIZE; i++) > + it61620_hdmi_reg_write(it61620, TX_REG_AVIINFO_DB01 + i, ptr[i]); > + > + it61620_hdmi_reg_write(it61620, TX_REG_AVIINFO_DB14, buffer[3]); > + > + /* Enable */ > + it61620_hdmi_enable_avi_infoframe(it61620); > +} > + > +static void it61620_hdmi_config_output(struct it61620 *it61620) > +{ > + struct drm_device *drm = it61620->drm; > + > + it61620_hdmi_reset(it61620); > + it61620_hdmi_poweron(it61620); > + it61620_hdmi_reg_set(it61620, TX_REG_HDMI_CTRL2, 0x70, 0x00); > + if (it61620->is_hdmi) { > + drm_dbg(drm, "HDMI\n"); > + it61620_hdmi_enable_hdmi_mode(it61620); > + it61620_hdmi_reg_set(it61620, TX_REG_EN_PKT2, > + (B_EN_GEN | B_GEN_RP), > + (B_EN_GEN | B_GEN_RP)); > + } else { > + drm_dbg(drm, "DVI\n"); > + it61620_hdmi_enable_DVI_mode(it61620); > + it61620_hdmi_reg_write(it61620, TX_REG_EN_PKT2, 0x00); > + it61620_hdmi_reg_write(it61620, TX_REG_EN_PKT1, 0x00); > + } > + > + it61620_hdmi_enable_avmute(it61620, false); > + it61620_hdmi_setup_afe(it61620, it61620->vm.pixelclock / 1000); > + it61620_hdmi_fire_afe(it61620); > + it61620->video_state = it61620_VIDEO_ON; > +} > + > +static int it61620_hdmi_audio_infoframe_set(struct it61620 *it61620, > + const u8 *buffer, size_t len) > +{ > + u8 i; > + const u8 *ptr; > + > + it61620_hdmi_disable_audio_infoframe(it61620); > + > + /* fill PB */ > + ptr = buffer + HDMI_INFOFRAME_HEADER_SIZE; > + for (i = 0; i < len - HDMI_INFOFRAME_HEADER_SIZE; i++) > + it61620_hdmi_reg_write(it61620, TX_REG_AUDINFO_DB01 + i, ptr[i]); > + > + it61620_hdmi_reg_write(it61620, TX_REG_AUDINFO_DB06, buffer[3]); > + it61620_hdmi_reg_write(it61620, TX_REG_AUDINFO_DB07, 0x00); > + it61620_hdmi_reg_write(it61620, TX_REG_AUDINFO_DB08, 0x00); > + it61620_hdmi_reg_write(it61620, TX_REG_AUDINFO_DB09, 0x00); > + it61620_hdmi_reg_write(it61620, TX_REG_AUDINFO_DB10, 0x00); > + > + /* Enable */ > + it61620_hdmi_enable_audio_infoframe(it61620); > + return 0; > +} > + > +static void it61620_start_hdcp_work(struct it61620 *it61620) > +{ > + it61620->hdcp_state = CP_GOING; > + queue_delayed_work(system_wq, &it61620->hdcp_work, > + msecs_to_jiffies(2400)); > +} > + > +static void it61620_stop_hdcp_work(struct it61620 *it61620) > +{ > + it61620->hdcp_state = CP_NONE; > + cancel_delayed_work_sync(&it61620->hdcp_work); > + it61620_hdmi_disable_hdcp(it61620); > +} > + > +static void it61620_hw_reset(struct it61620 *it61620) > +{ > + struct it61620_platform_data *pdata = &it61620->pdata; > + > + if (!pdata->gpiod_reset) > + return; > + > + gpiod_set_value_cansleep(pdata->gpiod_reset, 1); > + > + usleep_range(10000, 20000); > + gpiod_set_value_cansleep(pdata->gpiod_reset, 0); > + usleep_range(10000, 20000); > +} > + > +static int it61620_enable_devices(struct it61620 *it61620) > +{ > + struct device *dev = &it61620->it61620_i2c->dev; > + unsigned int device_id[5]; > + unsigned int i, vid, pid; > + > + regmap_write(it61620->it61620_regmap, REG_CTRL_PW, 0x55); > + regmap_write(it61620->it61620_regmap, REG_CTRL_PW, 0xAA); > + regmap_write(it61620->it61620_regmap, REG_CTRL_PW, 0xC3); > + regmap_write(it61620->it61620_regmap, REG_CTRL_PW, 0xA5); > + usleep_range(1000, 2000); > + > + for (i = 0; i < 5; i++) > + device_id[i] = it61620_mipi_reg_read(it61620, > + REG_VENDER_ID_L + i); > + > + dev_dbg(dev, "IT61620 ver %02X", device_id[4]); > + > + vid = (device_id[1] << 8) | device_id[0]; > + pid = (device_id[3] << 8) | device_id[2]; > + > + if (vid != it61620->chip_info->vid || > + pid != it61620->chip_info->pid) { > + dev_err(dev, "vid %X != %X", > + vid, it61620->chip_info->vid); > + dev_err(dev, "pid %X != %X", > + pid, it61620->chip_info->pid); > + > + return -ENODEV; > + } > + > + it61620->dev_ver = device_id[4]; > + return 0; > +} > + > +static void it61620_int_setup(struct it61620 *it61620) > +{ > + /* SET INT# to Active Low open-drain */ > + it61620_mipi_reg_set(it61620, RX_REG_INT_POL, 0x08, 0x08); > + it61620_hdmi_reg_set(it61620, TX_REG_SYS_CONFIG, 0x0F, B_INT_MODE); > + it61620_hdmi_reg_set(it61620, REG_TX_INT_CTRL, B_DIS_INT_OUTPUT, 0x00); > +} > + > +static void it61620_int_enable(struct it61620 *it61620) > +{ > + it61620_hdmi_reg_set(it61620, TX_REG_INT_MASK1, B_HPD_CHG, B_HPD_CHG); > +} > + > +static int it61620_reset_init(struct it61620 *it61620) > +{ > + it61620_hw_reset(it61620); > + > + if (it61620_enable_devices(it61620) < 0) > + return -ENODEV; > + > + it61620_mipi_reset(it61620); > + it61620_hdmi_reset(it61620); > + it61620_int_setup(it61620); > + it61620_int_enable(it61620); > + it61620_hdmi_powerdown(it61620); > + > + return 0; > +} > + > +static int it61620_poweron(struct it61620 *it61620) > +{ > + struct it61620_platform_data *pdata = &it61620->pdata; > + struct drm_device *drm = it61620->drm; > + struct device *dev = it61620->dev; > + int err; > + > + if (it61620->powered) { > + drm_dbg(drm, "Already powered on"); > + return 0; > + } > + > + err = regulator_enable(pdata->ivdd); > + if (err) { > + dev_err(dev, "Failed to enable IVDD: %d", err); > + goto poweron_exit; > + } > + > + err = regulator_enable(pdata->ovdd1833); > + if (err) { > + dev_err(dev, "Failed to enable OVDD1833: %d", err); > + goto disable_ivdd; > + } > + > + err = regulator_enable(pdata->ovdd33); > + if (err) { > + dev_err(dev, "Failed to enable OVDD33: %d", err); > + goto disable_ovdd1833; > + } > + > + gpiod_set_value_cansleep(pdata->gpiod_reset, 1); > + usleep_range(10000, 20000); > + gpiod_set_value_cansleep(pdata->gpiod_reset, 0); > + usleep_range(10000, 20000); > + > + err = it61620_reset_init(it61620); > + if (err < 0) > + goto disable_ovdd33; > + > + it61620->powered = true; > + it61620->hpd = it61620_hdmi_get_hpd_status(it61620); > + if (it61620->it61620_i2c->irq) { > + enable_irq(it61620->it61620_i2c->irq); > + drm_dbg(drm, "enable irq %d\n", > + it61620->it61620_i2c->irq); > + } > + drm_dbg(drm, "it61620 poweron end\n"); > + return 0; > + > +disable_ovdd33: > + regulator_disable(pdata->ovdd33); > +disable_ovdd1833: > + regulator_disable(pdata->ovdd1833); > +disable_ivdd: > + regulator_disable(pdata->ivdd); > +poweron_exit: > + return err; > +} > + > +static int it61620_poweroff(struct it61620 *it61620) > +{ > + struct it61620_platform_data *pdata = &it61620->pdata; > + struct drm_device *drm = it61620->drm; > + struct device *dev = it61620->dev; > + int err; > + > + if (!it61620->powered) { > + drm_dbg(drm, "Already powered off"); > + return 0; > + } > + > + if (it61620->it61620_i2c->irq) { > + disable_irq(it61620->it61620_i2c->irq); > + drm_dbg(drm, "disable irq %d\n", > + it61620->it61620_i2c->irq); > + } > + > + gpiod_set_value_cansleep(pdata->gpiod_reset, 1); > + > + err = regulator_disable(pdata->ovdd33); > + if (err) > + dev_err(dev, "Failed to disable ovdd33: %d", err); > + > + err = regulator_disable(pdata->ivdd); > + if (err) > + dev_err(dev, "Failed to disable IVDD: %d", err); > + > + usleep_range(2000, 3000); > + > + err = regulator_disable(pdata->ovdd1833); > + if (err) > + dev_err(dev, "Failed to disable ovdd1833: %d", err); > + > + it61620->powered = false; > + it61620->hpd = false; > + it61620->connector_status = connector_status_disconnected; > + it61620_remove_edid(it61620); > + drm_dbg(drm, "it61620 poweroff\n"); > + > + return 0; > +} > + > +static void it61620_config_default(struct it61620 *it61620) > +{ > + struct it61620_mipirx *mipirx = &it61620->mipirx_config; > + struct it61620_audio *audio_config = &it61620->audio_config; > + > + mipirx->lane_num = 4; > + mipirx->pn_swap = 0; > + mipirx->lane_swap = 0; > + it61620->connector_status = connector_status_disconnected; > + > + audio_config->select = I2S; > + audio_config->sample_rate = SAMPLE_RATE_48K; > + audio_config->type = LPCM; > + audio_config->word_length = WORD_LENGTH_16BIT; > + audio_config->channel_count = 2; > + audio_config->audfmt = 0; > +} > + > +static void it61620_show_drm_video_mode(struct it61620 *it61620, > + const struct videomode *vm) > +{ > + struct drm_device *drm = it61620->drm; > + > + drm_dbg(drm, "HActive = %u\n", vm->hactive); > + drm_dbg(drm, "VActive = %u\n", vm->vactive); > + drm_dbg(drm, "HTotal = %u\n", > + vm->hactive + vm->hfront_porch + vm->hsync_len + > + vm->hback_porch); > + drm_dbg(drm, "VTotal = %u\n", > + vm->vactive + vm->vfront_porch + vm->vsync_len + > + vm->vback_porch); > + drm_dbg(drm, "PCLK = %lukhz\n", vm->pixelclock / 1000); > + drm_dbg(drm, "HFP = %u\n", vm->hfront_porch); > + drm_dbg(drm, "HSW = %u\n", vm->hsync_len); > + drm_dbg(drm, "HBP = %u\n", vm->hback_porch); > + drm_dbg(drm, "VFP = %u\n", vm->vfront_porch); > + drm_dbg(drm, "VSW = %u\n", vm->vsync_len); > + drm_dbg(drm, "VBP = %u\n", vm->vback_porch); > + if (vm->flags & DISPLAY_FLAGS_HSYNC_HIGH) > + drm_dbg(drm, "HPOL +\n"); > + else > + drm_dbg(drm, "HPOL -\n"); > + > + if (vm->flags & DISPLAY_FLAGS_VSYNC_HIGH) > + drm_dbg(drm, "VPOL +\n"); > + else > + drm_dbg(drm, "VPOL -\n"); > + > + if (vm->flags & DISPLAY_FLAGS_INTERLACED) > + drm_dbg(drm, "Intelaced\n"); > + else > + drm_dbg(drm, "Progressive\n"); > +} > + > +static enum drm_mode_status it61620_mode_valid(struct it61620 *it61620, > + const struct drm_display_mode *mode) > +{ > + if (mode->clock > 300000) > + return MODE_CLOCK_HIGH; > + > + return MODE_OK; > +} > + > +static int it61620_get_edid_block(void *data, u8 *buf, unsigned int block, > + size_t len) > +{ > + struct it61620 *it61620 = data; > + unsigned int edid_offset; > + unsigned int cnt; > + unsigned int i; > + int ret = 0; > + > + if (len > EDID_LENGTH) > + return -EINVAL; > + > + guard(mutex)(&it61620->ddc_lock); > + > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, DDC_COMMAND_FIFO_CLR); > + > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_ADDR, DDC_EDID_ADDR); > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_SEGMENT, block / 2); > + > + cnt = 0; > + edid_offset = block * 128; > + > + for (i = 0; i < EDID_LENGTH; i += EDID_R_BURST_NUM, > + edid_offset += EDID_R_BURST_NUM, > + cnt += EDID_R_BURST_NUM) { > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_OFFSET, edid_offset); > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_SEGMENT, block >> 1); > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_NUM_L, > + EDID_R_BURST_NUM); > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_NUM_H, > + (EDID_R_BURST_NUM >> 8)); > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, > + DDC_COMMAND_EDID_RD); > + > + if (it61620_hdmi_ddc_wait(it61620) < 0) { > + it61620_hdmi_ddc_abort(it61620); > + ret = -EIO; > + break; > + } > + > + it61620_hdmi_get_ddc_fifo(it61620, &buf[cnt], EDID_R_BURST_NUM); > + } > + > + return ret; > +} > + > +static void it61620_set_capability_from_edid_parse(struct it61620 *it61620, > + const struct edid *edid) > +{ > + struct drm_device *drm = it61620->drm; > + > + it61620->is_hdmi = drm_detect_hdmi_monitor(edid); > + it61620->en_audio = drm_detect_monitor_audio(edid); > + > + drm_dbg(drm, "%s mode, monitor %ssupport audio", > + it61620->is_hdmi ? "HDMI" : "DVI", > + it61620->en_audio ? "" : "not "); > +} > + > +static int it61620_ddc_xfer_write(struct it61620 *it61620, > + u8 *buf, unsigned int num) > +{ > + it61620_hdmi_set_ddc_fifo(it61620, buf, num); > + > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, DDC_COMMAND_BURST_W); > + if (it61620_hdmi_ddc_wait(it61620) < 0) { > + it61620_hdmi_ddc_abort(it61620); > + return -EIO; > + } > + > + return num; > +} > + > +static int it61620_ddc_xfer_read(struct it61620 *it61620, u8 *buf, > + unsigned int num) > +{ > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, DDC_COMMAND_BURST_R); > + if (it61620_hdmi_ddc_wait(it61620) < 0) { > + it61620_hdmi_ddc_abort(it61620); > + return -EIO; > + } > + it61620_hdmi_get_ddc_fifo(it61620, buf, num); > + return num; > +} > + > +static int it61620_ddc_xfer(struct it61620 *it61620, struct i2c_msg *msgs) > +{ > + int ret; > + > + if (msgs->len > DDC_FIFO_DEPTH) > + return -EINVAL; > + > + guard(mutex)(&it61620->ddc_lock); > + > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, DDC_COMMAND_FIFO_CLR); > + > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_ADDR, msgs->addr << 1); > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_OFFSET, 0); > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_NUM_L, msgs->len); > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_NUM_H, (msgs->len >> 8)); > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_SEGMENT, 0); > + > + if ((msgs->flags & I2C_M_RD) == 0) > + ret = it61620_ddc_xfer_write(it61620, msgs->buf, msgs->len); > + else > + ret = it61620_ddc_xfer_read(it61620, msgs->buf, msgs->len); > + > + return ret; > +} > + > +static void it61620_enable_audio(struct it61620 *it61620) > +{ > + it61620_hdmi_reg_set(it61620, TX_REG_RESET_2_CTRL, 0x01, 0x00); > +} > + > +static void it61620_disable_audio(struct it61620 *it61620) > +{ > + it61620_hdmi_reg_set(it61620, TX_REG_RESET_2_CTRL, 0x01, 0x01); > + it61620_hdmi_reg_set(it61620, TX_REG_LINK_CTRL0, > + B_EN_AUDIO_MUTE, B_EN_AUDIO_MUTE); > +} > + > +static void it61620_config_audio(struct it61620 *it61620) > +{ > + struct it61620_audio *config = &it61620->audio_config; > + struct drm_device *drm = it61620->drm; > + u8 audsrc; > + > + drm_dbg(drm, "sample rate %d", config->sample_rate); > + drm_dbg(drm, "sample width %d", config->sample_width); > + drm_dbg(drm, "fmt %d", config->select); > + > + it61620_hdmi_reg_set(it61620, TX_REG_AUD_FMT, 0x7F, > + (config->word_length << 5) | config->audfmt); > + if (config->select == SPDIF) { > + it61620_hdmi_reg_write(it61620, TX_REG_AUD_FIFO1, 0x00); > + it61620_hdmi_reg_write(it61620, TX_REG_AUD_FIFO2, 0x00); > + it61620_hdmi_reg_set(it61620, TX_REG_AUD_SPDIF, 0x0F, 0x02); > + it61620_hdmi_reg_write(it61620, TX_REG_AUD_CTRL, 0X01); > + } else { > + it61620_hdmi_reg_write(it61620, TX_REG_AUD_FIFO1, 0x10); > + it61620_hdmi_reg_write(it61620, TX_REG_AUD_FIFO2, 0x32); > + it61620_hdmi_reg_write(it61620, TX_REG_AUD_CTRL, 0X00); > + } > + > + if (config->type == LPCM) > + it61620_hdmi_reg_write(it61620, TX_REG_AUD_STS1, 0x00); > + else > + it61620_hdmi_reg_write(it61620, TX_REG_AUD_STS1, B_EN_AUD_NLPCM); > + it61620_hdmi_reg_write(it61620, TX_REG_AUD_STS2, (config->sample_rate)); > + it61620_hdmi_reg_write(it61620, TX_REG_AUD_STS3, > + ((~(config->sample_rate << 4)) & 0xF0) + 0x0B); > + > + switch (config->channel_count) { > + case 2: > + audsrc = 0x01; > + break; > + case 3: > + audsrc = 0x03; > + break; > + case 4: > + audsrc = 0x03; > + break; > + case 5: > + audsrc = 0x07; > + break; > + case 6: > + audsrc = 0x07; > + break; > + case 7: > + audsrc = 0x0f; > + break; > + case 8: > + audsrc = 0x0f; > + break; > + default: > + drm_dbg(drm, > + "Error: Audio Channel Number Error !!!\n"); > + audsrc = 0x01; > + break; > + } > + > + it61620_hdmi_reg_write(it61620, TX_REG_EN_AUDIO, audsrc); > + > + it61620_hdmi_reg_set(it61620, TX_REG_LINK_CTRL0, B_EN_AUDIO_MUTE, 0x00); > + it61620_hdmi_reg_set(it61620, TX_REG_RESET_2_CTRL, 0x01, 0x00); > +} > + > +static irqreturn_t it61620_int_threaded_handler(int unused, void *data) > +{ > + struct it61620 *it61620 = data; > + struct device *dev = it61620->dev; > + > + pm_runtime_get_sync(dev); > + > + it61620_mipi_irq_handler(it61620); > + it61620_hdmi_irq(it61620); > + > + pm_runtime_mark_last_busy(dev); > + pm_runtime_put_autosuspend(dev); > + > + return IRQ_HANDLED; > +} > + > +static int it61620_audio_update_hw_params(struct it61620 *it61620, > + struct hdmi_codec_daifmt *fmt, > + struct hdmi_codec_params *hparms) > +{ > + struct it61620_audio *config = &it61620->audio_config; > + > + memcpy(config->channel_status, &hparms->iec.status[0], > + AES_IEC958_STATUS_SIZE); > + > + config->channel_number = hparms->channels; > + > + switch (hparms->sample_rate) { > + case 32000: > + config->sample_rate = SAMPLE_RATE_32K; > + break; > + case 44100: > + config->sample_rate = SAMPLE_RATE_44_1K; > + break; > + case 48000: > + config->sample_rate = SAMPLE_RATE_48K; > + break; > + case 88200: > + config->sample_rate = SAMPLE_RATE_88_2K; > + break; > + case 96000: > + config->sample_rate = SAMPLE_RATE_96K; > + break; > + case 176400: > + config->sample_rate = SAMPLE_RATE_176_4K; > + break; > + case 192000: > + config->sample_rate = SAMPLE_RATE_192K; > + break; > + default: > + return -EINVAL; > + } > + > + switch (hparms->sample_width) { > + case 16: > + config->sample_width = WORD_LENGTH_16BIT; > + break; > + case 24: > + config->sample_width = WORD_LENGTH_18BIT; > + break; > + case 18: > + config->sample_width = WORD_LENGTH_20BIT; > + break; > + case 20: > + config->sample_width = WORD_LENGTH_24BIT; > + break; > + default: > + return -EINVAL; > + } > + > + switch (fmt->fmt) { > + case HDMI_I2S: > + config->select = I2S; > + break; > + case HDMI_SPDIF: > + config->select = SPDIF; > + break; > + default: > + return -EINVAL; > + } > + > + it61620_hdmi_audio_set_ncts(it61620, hparms->sample_rate); > + it61620_config_audio(it61620); > + return 0; > +} > + > +static void it61620_hdcp_work(struct work_struct *work) > +{ > + struct it61620 *it61620 = container_of(work, struct it61620, > + hdcp_work.work); > + it61620_hdmi_reset_hdcp(it61620); > + if (!it61620_hdmi_start_hdcp(it61620) && > + it61620->hdcp_state == CP_GOING) { > + it61620_hdmi_disable_hdcp(it61620); > + it61620_start_hdcp_work(it61620); > + } > +} > + > +static int it61620_hdmi_i2c_xfer(struct i2c_adapter *adap, > + struct i2c_msg *msgs, int num) > +{ > + struct it61620 *it61620 = i2c_get_adapdata(adap); > + struct device *dev = it61620->dev; > + int i, j; > + > + for (i = 0 ; i < num ; i++) { > + dev_dbg(dev, > + " msg [%d] addr = %X, flag = %X, len = %d\n", > + i, msgs[i].addr, msgs[i].flags, msgs[i].len); > + > + if ((msgs[i].flags & I2C_M_RD) == 0) > + for (j = 0 ; j < msgs[i].len ; j++) > + dev_dbg(dev, > + "buf[%d] = %x\n", j, msgs[i].buf[j]); > + > + num = it61620_ddc_xfer(it61620, &msgs[i]); > + } > + > + return num; > +} > + > +static u32 it61620_hdmi_i2c_func(struct i2c_adapter *adapter) > +{ > + return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL; > +} > + > +static const struct i2c_algorithm hdmi_ddc_algorithm = { > + .master_xfer = it61620_hdmi_i2c_xfer, > + .functionality = it61620_hdmi_i2c_func, > +}; > + > +static struct i2c_adapter *it61620_add_ddc_i2c_adapter(struct it61620 *it61620) > +{ > + struct i2c_adapter *adap = &it61620->ddc; > + struct device *dev = it61620->dev; > + int ret; > + > + adap->owner = THIS_MODULE; > + adap->dev.parent = dev; > + adap->algo = &hdmi_ddc_algorithm; > + strscpy(adap->name, "ITE 61620 HDMI", sizeof(adap->name)); > + i2c_set_adapdata(adap, it61620); > + > + ret = i2c_add_adapter(adap); > + if (ret) { > + dev_err(dev, > + "cannot add %s I2C adapter\n", adap->name); > + return ERR_PTR(ret); > + } > + > + return 0; > +} > + > +static int it61620_i2c_and_regmap_init(struct i2c_client *client, > + struct it61620 *it61620) > +{ > + struct device *dev = it61620->dev; > + > + it61620->it61620_i2c = client; > + > + it61620->tx_i2c = devm_i2c_new_dummy_device(dev, > + client->adapter, > + TX_I2C_ADDRESS); > + if (IS_ERR(it61620->tx_i2c)) > + return dev_err_probe(dev, PTR_ERR(it61620->tx_i2c), > + "failed to create TX dummy i2c device at 0x%02x\n", > + TX_I2C_ADDRESS); > + > + it61620->mipirx_i2c = devm_i2c_new_dummy_device(dev, > + client->adapter, > + MIPIRX_I2C_ADDRESS); > + if (IS_ERR(it61620->mipirx_i2c)) > + return dev_err_probe(dev, PTR_ERR(it61620->mipirx_i2c), > + "failed to create MIPI dummy i2c device at 0x%02x\n", > + MIPIRX_I2C_ADDRESS); > + > + it61620->it61620_regmap = devm_regmap_init_i2c(it61620->it61620_i2c, > + &it61620_regmap_config); > + if (IS_ERR(it61620->it61620_regmap)) > + return dev_err_probe(dev, PTR_ERR(it61620->it61620_regmap), > + "failed to init I2C regmap for it61620\n"); > + > + it61620->tx_regmap = devm_regmap_init_i2c(it61620->tx_i2c, > + &it61620_tx_regmap_config); > + if (IS_ERR(it61620->tx_regmap)) > + return dev_err_probe(dev, PTR_ERR(it61620->tx_regmap), > + "failed to init I2C regmap for TX\n"); > + > + it61620->mipirx_regmap = devm_regmap_init_i2c(it61620->mipirx_i2c, > + &it61620_mipi_regmap_config); > + if (IS_ERR(it61620->mipirx_regmap)) > + return dev_err_probe(dev, PTR_ERR(it61620->mipirx_regmap), > + "failed to init I2C regmap for MIPI\n"); > + return 0; > +} > + > +static int it61620_of_get_dsi_host(struct it61620 *it61620, > + struct mipi_dsi_host **host) > +{ > + struct device *dev = it61620->dev; > + struct device_node *dsi_node; > + struct device_node *host_node; > + > + dsi_node = of_graph_get_next_endpoint(dev->of_node, NULL); > + > + if (!dsi_node) > + return dev_err_probe(dev, -ENODEV, "DSI NO endpoint at DT\n"); > + > + host_node = of_graph_get_remote_port_parent(dsi_node); > + of_node_put(dsi_node); > + > + if (!host_node) > + return dev_err_probe(dev, -ENODEV, "DSI NO host node at DT\n"); > + > + *host = of_find_mipi_dsi_host_by_node(host_node); > + of_node_put(host_node); > + > + if (*host) > + return 0; > + > + return dev_err_probe(dev, -EPROBE_DEFER, "failed to find dsi host\n"); > +} > + > +static int it61620_attach_dsi(struct it61620 *it61620, > + struct mipi_dsi_host *host) > +{ > + struct device *dev = it61620->dev; > + struct mipi_dsi_device *dsi; > + const struct mipi_dsi_device_info info = {"it61620", > + 0, > + dev->of_node}; > + > + dsi = devm_mipi_dsi_device_register_full(dev, host, &info); > + if (IS_ERR(dsi)) > + return dev_err_probe(dev, PTR_ERR(dsi), "failed to create dsi device\n"); > + > + it61620->dsi = dsi; > + dsi->lanes = 4; > + dsi->format = MIPI_DSI_FMT_RGB888; > + dsi->mode_flags = MIPI_DSI_MODE_VIDEO | > + MIPI_DSI_MODE_VIDEO_SYNC_PULSE; > + > + return devm_mipi_dsi_attach(dev, dsi); > +} > + > +static void it61620_detach_dsi(struct it61620 *it61620) > +{ > + if (!it61620->dsi) > + return; > + > + mipi_dsi_detach(it61620->dsi); > +} > + > +static unsigned int it61620_parse_dt(struct it61620 *it61620) > +{ > + struct device *dev = it61620->dev; > + struct device_node *np = it61620->dev->of_node; > + u32 num_lanes = 0; > + > + if (!dev->of_node) > + return -EINVAL; > + > + if (of_property_read_u32(np, "dsi-lanes", &num_lanes)) > + dev_dbg(dev, > + "cannot read dsi-lanes reg property\n"); > + else > + it61620->mipirx_config.lane_num = num_lanes; > + > + dev_dbg(dev, "num_lanes = %x\n", num_lanes); > + > + it61620->next_bridge = devm_drm_of_get_bridge(dev, np, 1, -1); > + if (IS_ERR(it61620->next_bridge)) > + return dev_err_probe(dev, -EPROBE_DEFER, > + "failed to get next bridge\n"); > + > + return 0; > +} > + > +static int it61620_init_pdata(struct it61620 *it61620) > +{ > + struct it61620_platform_data *pdata = &it61620->pdata; > + struct device *dev = it61620->dev; > + > + pdata->gpiod_reset = devm_gpiod_get(dev, "reset", GPIOD_OUT_HIGH); > + if (IS_ERR(pdata->gpiod_reset)) > + return dev_err_probe(dev, PTR_ERR(pdata->gpiod_reset), > + "gpiod_reset not found\n"); > + > + pdata->ivdd = devm_regulator_get(dev, "ivdd"); > + if (IS_ERR(pdata->ivdd)) > + return dev_err_probe(dev, PTR_ERR(pdata->ivdd), > + "ivdd regulator not found\n"); > + > + pdata->ovdd1833 = devm_regulator_get(dev, "ovdd1833"); > + if (IS_ERR(pdata->ovdd1833)) > + return dev_err_probe(dev, PTR_ERR(pdata->ovdd1833), > + "ovdd1833 regulator not found\n"); > + > + pdata->ovdd33 = devm_regulator_get(dev, "ovdd"); > + if (IS_ERR(pdata->ovdd33)) > + return dev_err_probe(dev, PTR_ERR(pdata->ovdd33), > + "ovdd33 regulator not found\n"); > + > + return 0; > +} > + > +static int __maybe_unused it61620_pm_bridge_suspend(struct device *dev) > +{ > + struct it61620 *it61620 = dev_get_drvdata(dev); > + > + it61620_poweroff(it61620); > + > + return 0; > +} > + > +static int __maybe_unused it61620_pm_bridge_resume(struct device *dev) > +{ > + struct it61620 *it61620 = dev_get_drvdata(dev); > + > + return it61620_poweron(it61620); > +} > + > +static const struct dev_pm_ops it61620_bridge_pm_ops = { > + SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend, > + pm_runtime_force_resume) > + SET_RUNTIME_PM_OPS(it61620_pm_bridge_suspend, > + it61620_pm_bridge_resume, NULL) > +}; > + > +static int it61620_bridge_attach(struct drm_bridge *bridge, > + struct drm_encoder *encoder, > + enum drm_bridge_attach_flags flags) > +{ > + struct it61620 *it61620 = bridge_to_it61620(bridge); > + struct drm_device *drm = bridge->dev; > + int ret; > + > + it61620->drm = drm; > + > + if (!drm_core_check_feature(drm, DRIVER_ATOMIC)) { > + drm_err(drm, > + "it61620 driver only copes with atomic updates\n"); > + return -EOPNOTSUPP; > + } > + > + ret = drm_bridge_attach(bridge->encoder, it61620->next_bridge, > + bridge, DRM_BRIDGE_ATTACH_NO_CONNECTOR); > + if (ret < 0) > + return ret; > + > + if (!(flags & DRM_BRIDGE_ATTACH_NO_CONNECTOR)) { > + drm_dbg(drm, > + "DRM_BRIDGE_ATTACH_NO_CONNECTOR must be supplied"); > + return -EINVAL; > + } > + return 0; > +} > + > +static void it61620_bridge_detach(struct drm_bridge *bridge) > +{ > +} > + > +static enum drm_mode_status it61620_bridge_mode_valid(struct drm_bridge *bridge, > + const struct drm_display_info *info, > + const struct drm_display_mode *mode) > +{ > + struct it61620 *it61620 = bridge_to_it61620(bridge); > + > + return it61620_mode_valid(it61620, mode); > +} > + > +static void it61620_bridge_hpd_notify(struct drm_bridge *bridge, > + enum drm_connector_status status) > +{ > + struct it61620 *it61620 = bridge_to_it61620(bridge); > + struct drm_device *drm = it61620->drm; > + struct device *dev = it61620->dev; > + int hpd, ret; > + > + hpd = (status == connector_status_connected) ? 1 : 0; > + > + if (it61620->connector_status != status) { > + drm_dbg(drm, "GPIO hpd status change %d->%d", > + !hpd, hpd); > + > + it61620->connector_status = status; > + if (hpd) { > + drm_dbg(drm, "HPD_GPIO get to wake up"); > + ret = pm_runtime_get_sync(dev); > + if (ret < 0) > + dev_err(dev, > + "pm_runtime_get_sync error %d", ret); > + } else { > + drm_dbg(drm, "HPD_GPIO put to sleep"); > + pm_runtime_mark_last_busy(dev); > + pm_runtime_put_autosuspend(dev); > + } > + > + } else { > + drm_dbg(drm, "GPIO hpd status NO change %d", hpd); > + } > +} > + > +static void it61620_bridge_atomic_pre_enable(struct drm_bridge *bridge, > + struct drm_atomic_state *state) > +{ > + struct it61620 *it61620 = bridge_to_it61620(bridge); > + struct device *dev = it61620->dev; > + > + pm_runtime_get_sync(dev); > +} > + > +static void it61620_bridge_atomic_enable(struct drm_bridge *bridge, > + struct drm_atomic_state *state) > +{ > + struct it61620 *it61620 = bridge_to_it61620(bridge); > + struct drm_crtc_state *crtc_state; > + struct drm_connector_state *conn_state; > + struct drm_display_mode *mode; > + struct drm_connector *connector; > + > + connector = drm_atomic_get_new_connector_for_encoder(state, > + bridge->encoder); > + > + if (!connector) > + return; > + it61620->connector = *connector; > + > + conn_state = drm_atomic_get_new_connector_state(state, connector); > + if (WARN_ON(!conn_state)) > + return; > + > + crtc_state = drm_atomic_get_new_crtc_state(state, conn_state->crtc); > + if (WARN_ON(!crtc_state)) > + return; > + > + mode = &crtc_state->adjusted_mode; > + if (WARN_ON(!mode)) > + return; > + > + drm_atomic_helper_connector_hdmi_update_infoframes(connector, state); > + it61620_mipi_set_d2v_video_timing(it61620); > + it61620_hdmi_config_output(it61620); > +} > + > +static void it61620_bridge_atomic_disable(struct drm_bridge *bridge, > + struct drm_atomic_state *state) > +{ > + struct it61620 *it61620 = bridge_to_it61620(bridge); > + > + if (it61620->powered) { > + it61620_stop_hdcp_work(it61620); > + it61620_hdmi_disable_afe(it61620); > + it61620_hdmi_powerdown(it61620); > + it61620->video_state = it61620_VIDEO_OFF; > + } > +} > + > +static void it61620_bridge_atomic_post_disable(struct drm_bridge *bridge, > + struct drm_atomic_state *state) > +{ > + struct it61620 *it61620 = bridge_to_it61620(bridge); > + struct device *dev = it61620->dev; > + > + pm_runtime_mark_last_busy(dev); > + pm_runtime_put_autosuspend(dev); > +} > + > +static const struct drm_edid *it61620_bridge_edid_read(struct drm_bridge *bridge, > + struct drm_connector *connector) > +{ > + struct it61620 *it61620 = bridge_to_it61620(bridge); > + struct device *dev = it61620->dev; > + > + if (!it61620->cached_edid) { > + it61620->cached_edid = drm_edid_read_custom(connector, > + it61620_get_edid_block, > + it61620); > + > + if (!it61620->cached_edid) { > + dev_err(dev, "failed to get edid!"); > + return NULL; > + } > + it61620_set_capability_from_edid_parse(it61620, > + drm_edid_raw(it61620->cached_edid)); > + } > + return drm_edid_dup(it61620->cached_edid); > +} > + > +static void it61620_bridge_mode_set(struct drm_bridge *bridge, > + const struct drm_display_mode *mode, > + const struct drm_display_mode *adj) > +{ > + struct it61620 *it61620 = bridge_to_it61620(bridge); > + > + drm_display_mode_to_videomode(adj, &it61620->vm); > +} > + > +static int it61620_bridge_hdmi_clear_infoframe(struct drm_bridge *bridge, > + enum hdmi_infoframe_type type) > +{ > + struct it61620 *it61620 = bridge_to_it61620(bridge); > + struct drm_device *drm = it61620->drm; > + > + switch (type) { > + case HDMI_INFOFRAME_TYPE_AVI: > + it61620_hdmi_disable_avi_infoframe(it61620); > + break; > + case HDMI_INFOFRAME_TYPE_AUDIO: > + it61620_hdmi_disable_audio_infoframe(it61620); > + break; > + default: > + drm_err(drm, "Error: hdmi infoframe_type %x!!!\n", type); > + } > + return 0; > +} > + > +static int it61620_bridge_hdmi_write_infoframe(struct drm_bridge *bridge, > + enum hdmi_infoframe_type type, > + const u8 *buffer, size_t len) > +{ > + struct it61620 *it61620 = bridge_to_it61620(bridge); > + struct drm_device *drm = it61620->drm; > + > + switch (type) { > + case HDMI_INFOFRAME_TYPE_AVI: > + it61620_hdmi_avi_infoframe_set(it61620, buffer, len); > + break; > + case HDMI_INFOFRAME_TYPE_AUDIO: > + it61620_hdmi_audio_infoframe_set(it61620, buffer, len); > + break; > + default: > + drm_err(drm, "Error: hdmi infoframe_type %x!!!\n", type); > + } > + return 0; > +} > + > +static int it61620_bridge_hdmi_audio_startup(struct drm_connector *connector, > + struct drm_bridge *bridge) > +{ > + struct it61620 *it61620 = bridge_to_it61620(bridge); > + > + it61620_enable_audio(it61620); > + return 0; > +} > + > +static int it61620_bridge_hdmi_audio_prepare(struct drm_connector *connector, > + struct drm_bridge *bridge, > + struct hdmi_codec_daifmt *fmt, > + struct hdmi_codec_params *hparms) > +{ > + struct it61620 *it61620 = bridge_to_it61620(bridge); > + > + switch (hparms->sample_rate) { > + case 32000: > + case 44100: > + case 48000: > + case 88200: > + case 96000: > + case 176400: > + case 192000: > + case 768000: > + break; > + default: > + return -EINVAL; > + } > + > + switch (hparms->sample_width) { > + case 16: > + case 24: > + case 18: > + case 20: > + break; > + default: > + return -EINVAL; > + } > + > + switch (fmt->fmt) { > + case HDMI_I2S: > + case HDMI_SPDIF: > + break; > + default: > + return -EINVAL; > + } > + > + it61620_audio_update_hw_params(it61620, fmt, hparms); > + > + return drm_atomic_helper_connector_hdmi_update_audio_infoframe(connector, > + &hparms->cea); > +} > + > +static void it61620_bridge_hdmi_audio_shutdown(struct drm_connector *connector, > + struct drm_bridge *bridge) > +{ > + struct it61620 *it61620 = bridge_to_it61620(bridge); > + > + it61620_disable_audio(it61620); > +} > + > +static const struct drm_bridge_funcs it61620_bridge_funcs = { > + .attach = it61620_bridge_attach, > + .detach = it61620_bridge_detach, > + .mode_valid = it61620_bridge_mode_valid, > + .hpd_notify = it61620_bridge_hpd_notify, > + > + .atomic_pre_enable = it61620_bridge_atomic_pre_enable, > + .atomic_enable = it61620_bridge_atomic_enable, > + .atomic_disable = it61620_bridge_atomic_disable, > + .atomic_post_disable = it61620_bridge_atomic_post_disable, > + .atomic_duplicate_state = drm_atomic_helper_bridge_duplicate_state, > + .atomic_destroy_state = drm_atomic_helper_bridge_destroy_state, > + .atomic_reset = drm_atomic_helper_bridge_reset, > + > + .edid_read = it61620_bridge_edid_read, > + .mode_set = it61620_bridge_mode_set, > + > + .hdmi_clear_infoframe = it61620_bridge_hdmi_clear_infoframe, > + .hdmi_write_infoframe = it61620_bridge_hdmi_write_infoframe, > + .hdmi_audio_startup = it61620_bridge_hdmi_audio_startup, > + .hdmi_audio_prepare = it61620_bridge_hdmi_audio_prepare, > + .hdmi_audio_shutdown = it61620_bridge_hdmi_audio_shutdown, > +}; > + > +static int it61620_probe(struct i2c_client *client) > +{ > + struct device *dev = &client->dev; > + struct device_node *np = dev->of_node; > + struct mipi_dsi_host *host; > + struct it61620 *it61620; > + int ret = 0; > + > + it61620 = devm_drm_bridge_alloc(dev, struct it61620, bridge, > + &it61620_bridge_funcs); > + if (IS_ERR(it61620)) > + return PTR_ERR(it61620); > + > + it61620->dev = dev; > + it61620->chip_info = of_device_get_match_data(dev); > + > + ret = it61620_of_get_dsi_host(it61620, &host); > + if (ret < 0) > + return ret; > + > + ret = it61620_i2c_and_regmap_init(client, it61620); > + if (ret < 0) > + return ret; > + > + i2c_set_clientdata(client, it61620); > + > + ret = it61620_init_pdata(it61620); > + if (ret < 0) > + return ret; > + > + it61620_config_default(it61620); > + it61620_parse_dt(it61620); > + if (ret < 0) > + return ret; > + > + if (!client->irq) > + return dev_err_probe(dev, -ENODEV, > + "Failed to get INTP IRQ\n"); > + > + ret = devm_request_threaded_irq(&client->dev, client->irq, NULL, > + it61620_int_threaded_handler, > + IRQF_TRIGGER_LOW | IRQF_ONESHOT | > + IRQF_NO_AUTOEN, > + "it61620-intp", it61620); > + if (ret < 0) > + return dev_err_probe(dev, ret, > + "failed to request INTP threaded IRQ\n"); > + > + INIT_DELAYED_WORK(&it61620->hdcp_work, it61620_hdcp_work); > + init_waitqueue_head(&it61620->wq); > + > + mutex_init(&it61620->ddc_lock); > + > + it61620_add_ddc_i2c_adapter(it61620); > + > + pm_runtime_enable(dev); > + pm_runtime_set_autosuspend_delay(dev, 1000); > + pm_runtime_use_autosuspend(dev); > + > + it61620->bridge.funcs = &it61620_bridge_funcs; > + it61620->bridge.of_node = np; > + it61620->bridge.ops = DRM_BRIDGE_OP_EDID | DRM_BRIDGE_OP_MODES | > + DRM_BRIDGE_OP_HDMI | > + DRM_BRIDGE_OP_HDMI_AUDIO; > + it61620->bridge.type = DRM_MODE_CONNECTOR_HDMIA; > + it61620->bridge.hdmi_audio_max_i2s_playback_channels = 8; > + it61620->bridge.hdmi_audio_spdif_playback = false; > + it61620->bridge.vendor = "ITE"; > + it61620->bridge.product = "IT61620"; > + > + ret = devm_drm_bridge_add(dev, &it61620->bridge); > + if (ret < 0) > + return dev_err_probe(dev, ret, > + "failed to add drm bridge\n"); > + > + ret = it61620_attach_dsi(it61620, host); > + if (ret < 0) > + return dev_err_probe(dev, ret, > + "failed to attach to DSI host\n"); > + > + return 0; > +} > + > +static void it61620_remove(struct i2c_client *client) > +{ > + struct it61620 *it61620 = i2c_get_clientdata(client); > + struct device *dev = it61620->dev; > + > + disable_irq(client->irq); > + pm_runtime_disable(dev); > + it61620_remove_edid(it61620); > + it61620_detach_dsi(it61620); > + > + mutex_destroy(&it61620->ddc_lock); > +} > + > +static const struct it6162_chip_info it61620_chip_info = { > + .vid = 0x4954, > + .pid = 0x6152, > +}; > + > +static const struct of_device_id it61620_dt_ids[] = { > + { .compatible = "ite,it61620", .data = &it61620_chip_info}, > + { } > +}; > +MODULE_DEVICE_TABLE(of, it61620_dt_ids); > + > +static const struct i2c_device_id it61620_i2c_ids[] = { > + { "it61620", 0 }, > + { }, > +}; > +MODULE_DEVICE_TABLE(i2c, it61620_i2c_ids); > + > +static struct i2c_driver it61620_driver = { > + .driver = { > + .name = "it61620", > + .of_match_table = it61620_dt_ids, > + .pm = &it61620_bridge_pm_ops, > + }, > + .probe = it61620_probe, > + .remove = it61620_remove, > + .id_table = it61620_i2c_ids, > +}; > + > +module_i2c_driver(it61620_driver); > + > +MODULE_AUTHOR("Pet Weng <pet.weng@ite.com.tw>"); > +MODULE_AUTHOR("Hermes Wu <Hermes.Wu@ite.com.tw>"); > +MODULE_DESCRIPTION("it61620 mipi to hdmi driver"); > +MODULE_LICENSE("GPL"); > > -- > 2.34.1 > Regards, Pin-yen ^ permalink raw reply [flat|nested] 7+ messages in thread
* RE: [PATCH 2/3] drm/bridge: Add ITE IT61620 MIPI DSI to HDMI bridge driver 2025-08-18 9:16 ` Pin-yen Lin @ 2025-08-20 3:29 ` Pet.Weng 0 siblings, 0 replies; 7+ messages in thread From: Pet.Weng @ 2025-08-20 3:29 UTC (permalink / raw) To: treapking Cc: andrzej.hajda, neil.armstrong, rfoss, Laurent.pinchart, jonas, jernej.skrabec, maarten.lankhorst, mripard, tzimmermann, airlied, simona, robh, krzk+dt, conor+dt, dri-devel, devicetree, linux-kernel, Hermes.Wu, Kenneth.Hung, treapking, Pet.Weng On Mon, Aug 18, 2025 at 5:16 PM Pin-yen Lin <treapking@chromium.org> wrote: > > Hi Pet, Hi Pin-yen, > > On Mon, Aug 18, 2025 at 5:01 PM Pet Weng <pet.weng@ite.com.tw> wrote: > > > > This adds support for the ITE IT61620 bridge chip which converts > > MIPI DSI input to HDMI output. The Driver implements the basic > > bridge functions and integrates with the DRM bridge and connector > > frameworks. > > > > Supported fetures include: > > MIPI DSI input handling > > HDMI output setup > > Basic mode configuration > > I2C-based control and initialization > > HDCP 1.4 handling > > > > This driver will be used on platforms embedding the IT61620 for > > video output via HDMI from SoCs with MIPI DSI output. > > > > Signed-off-by: Pet Weng <pet.weng@ite.com.tw> > > --- > > drivers/gpu/drm/bridge/Kconfig | 19 + > > drivers/gpu/drm/bridge/Makefile | 1 + > > drivers/gpu/drm/bridge/ite-it61620.c | 3004 ++++++++++++++++++++++++++++++++++ > > 3 files changed, 3024 insertions(+) > > > > diff --git a/drivers/gpu/drm/bridge/Kconfig b/drivers/gpu/drm/bridge/Kconfig > > index b9e0ca85226a603a24f90c6879d1499f824060cb..a64ae9004197d0ae9c49f450b799cc4be253ffa9 100644 > > --- a/drivers/gpu/drm/bridge/Kconfig > > +++ b/drivers/gpu/drm/bridge/Kconfig > > @@ -111,6 +111,25 @@ config DRM_ITE_IT6263 > > help > > ITE IT6263 LVDS to HDMI bridge chip driver. > > > > +config DRM_ITE_IT61620 > > + tristate "ITE IT61620 DSI/HDMI bridge" > > + depends on OF > > + select DRM_DISPLAY_CONNECTOR > > + select DRM_DISPLAY_HDMI_HELPER > > + select DRM_DISPLAY_HDCP_HELPER > > + select DRM_DISPLAY_HELPER > > + select DRM_MIPI_DSI > > + select DRM_KMS_HELPER > > + select DRM_HDMI_HELPER > > + select CRYPTO > > + select CRYPTO_HASH > > + help > > + Driver for ITE IT61620 MIPI DSI to HDMI bridge > > + chip driver. > > + > > + It enables display output through HDMI when connected to a MIPI > > + DSI source. The bridge translates the video signals for HDMI monitors. > > + > > config DRM_ITE_IT6505 > > tristate "ITE IT6505 DisplayPort bridge" > > depends on OF > > diff --git a/drivers/gpu/drm/bridge/Makefile b/drivers/gpu/drm/bridge/Makefile > > index 245e8a27e3fc525ffe02103e4436c71313f55d9a..c6cc41ea120c9d05146bd414e3dc5e7318867057 100644 > > --- a/drivers/gpu/drm/bridge/Makefile > > +++ b/drivers/gpu/drm/bridge/Makefile > > @@ -11,6 +11,7 @@ tda998x-y := tda998x_drv.o > > obj-$(CONFIG_DRM_I2C_NXP_TDA998X) += tda998x.o > > > > obj-$(CONFIG_DRM_ITE_IT6263) += ite-it6263.o > > +obj-$(CONFIG_DRM_ITE_IT61620) += ite-it61620.o > > obj-$(CONFIG_DRM_ITE_IT6505) += ite-it6505.o > > obj-$(CONFIG_DRM_LONTIUM_LT8912B) += lontium-lt8912b.o > > obj-$(CONFIG_DRM_LONTIUM_LT9211) += lontium-lt9211.o > > diff --git a/drivers/gpu/drm/bridge/ite-it61620.c b/drivers/gpu/drm/bridge/ite-it61620.c > > new file mode 100644 > > index 0000000000000000000000000000000000000000..d3db2fdf3da714e54efe2d198bb814550880d45f > > --- /dev/null > > +++ b/drivers/gpu/drm/bridge/ite-it61620.c > > @@ -0,0 +1,3004 @@ > > +// SPDX-License-Identifier: GPL-2.0 > > +/* > > + * Copyright (C) 2025 ITE Tech. Inc. > > + */ > > + > > +#include <linux/gpio/consumer.h> > > +#include <linux/i2c.h> > > +#include <linux/module.h> > > +#include <linux/of.h> > > +#include <linux/of_irq.h> > > +#include <linux/of_graph.h> > > +#include <linux/regmap.h> > > +#include <linux/pm_runtime.h> > > +#include <drm/drm_drv.h> > > +#include <drm/drm_atomic_helper.h> > > +#include <drm/drm_bridge.h> > > +#include <drm/drm_probe_helper.h> > > +#include <drm/drm_edid.h> > > +#include <drm/drm_mipi_dsi.h> > > +#include <drm/drm_print.h> > > +#include <drm/display/drm_hdcp_helper.h> > > +#include <drm/display/drm_hdmi_helper.h> > > +#include <drm/display/drm_hdmi_state_helper.h> > > +#include <video/videomode.h> > > +#include <sound/hdmi-codec.h> > > +#include <crypto/hash.h> > > + > > +#define EDID_R_BURST_NUM 16 > > +#define DDC_FIFO_DEPTH 32 > > + > > +#define MIPIRX_I2C_ADDRESS (0x78 >> 1) > > +#define TX_I2C_ADDRESS (0xC0 >> 1) > > + > > +#define REG_CTRL_PW 0xFF > > + > > +#define REG_VENDER_ID_L 0x00 > > +#define REG_VENDER_ID_H 0x01 > > +#define REG_DEVICE_ID_L 0x02 > > +#define REG_DEVICE_ID_H 0x03 > > +#define REG_DEV_VERSION 0x04 > > +#define DEV_VERSION_A0 0xA0 > > +#define DEV_VERSION_C0 0xC0 > > + > > +#define RX_REG_BANK 0x0F > > +#define M_MIPIRX_BANK 0x01 > > + > > +#define RX_REG_RESET_CTRL 0x05 > > +#define B_REF_CLOCK_RESET BIT(3) > > +#define RX_REG_CLK_CTRL 0x10 > > +#define B_MIPI_INT_STATUS BIT(7) > > +#define RX_REG_D_RST 0x1A > > +#define B_D_RST BIT(0) > > +#define RX_REG_INT_STATUS_01 0x0A > > +#define B_INI_V_CHG BIT(0) > > +#define RX_REG_INT_POL 0x11 > > +#define RX_REG_INT_MASK 0x114 > > +#define B_V_CHG BIT(0) > > +#define RX_REG_INT_STATUS_02 0x22 > > +#define B_INI_V_STB BIT(5) > > +#define RX_REG_MPPCLKI 0x12 > > + > > +#define RX_REG_HFP_L 0x30 > > +#define RX_REG_HFP_H 0x31 > > +#define RX_REG_HSW_L 0x32 > > +#define RX_REG_HSW_H 0x33 > > +#define RX_REG_HBP_L 0x34 > > +#define RX_REG_HBP_H 0x35 > > +#define RX_REG_HDEW_L 0x36 > > +#define RX_REG_HDEW_H 0x37 > > +#define RX_REG_HTOTAL_L 0x48 > > +#define RX_REG_HTOTAL_H 0x49 > > + > > +#define RX_REG_SELDCLK 0x24 > > +#define RX_REG_VFP_L 0x3A > > +#define RX_REG_VFP_H 0x3B > > +#define RX_REG_VSW_L 0x3C > > +#define RX_REG_VSW_H 0x3D > > +#define RX_REG_VBP_L 0x3E > > +#define RX_REG_VBP_H 0x3F > > +#define RX_REG_VDEW_L 0x40 > > +#define RX_REG_VDEW_H 0x41 > > +#define RX_REG_POL 0x4E > > +#define B_MIPI_H_POL BIT(0) > > +#define B_MIPI_V_POL BIT(1) > > + > > +#define RX_REG_DSCCTRL 0x25 > > +#define RX_REG_SYNC_NUM 0x4D > > +#define RX_REG_BSP_SEL 0x1F > > +#define RX_REG_PWD_CTRL 0xE0 > > +#define RX_REG_ENVRR 0x1AC > > +#define RX_REG_ENVBLK 0x1AD > > + > > +#define RX_REG_D2P_RESET 0xA0 > > +#define RX_REG_D2P_CTRL 0xA1 > > +#define RX_REG_AUTO_D2P_RESET 0xA2 > > +#define RX_REG_TUNEOPT 0xA9 > > +#define RX_REG_TUNETHRE 0xAA > > +#define RX_REG_DSC_RESET 0xAB > > +#define RX_REG_DSC_VFRD 0xAC > > + > > +#define RX_REG_MIPI_CONFIG 0x112 > > +#define B_MIPI_LANE_NUM 0x03 > > +#define B_MIPI_PN_SWAP BIT(2) > > +#define B_MIPI_LANE_SWAP BIT(3) > > +#define RX_REG_HS_CTRL 0x118 > > +#define RX_REG_LP_CTRL 0x119 > > +#define RX_REG_MIPI_CTRL01 0x44 > > +#define RX_REG_AUTO_SYNC 0x144 > > +#define RX_REG_MV_MAX 0x146 > > +#define RX_REG_FORCE_M 0x147 > > +#define B_FORCE_MHT_STB BIT(0) > > +#define B_FORCE_MVT_STB BIT(3) > > +#define RX_REG_MIPI_CTRL02 0x14E > > +#define B_FIFO_RST BIT(5) > > + > > +#define TX_REG_STATUS01 0x07 > > +#define B_INT_STATUS BIT(0) > > +#define B_HPD_STATUS BIT(1) > > +#define B_VIDEO_STB BIT(2) > > + > > +#define TX_REG_HDMITX_BANK 0x0F > > +#define M_HDMITX_BANK 0x03 > > +#define B_INT_EVENT_HDMI BIT(4) > > +#define TX_REG_RESET_1_CTRL 0x05 > > +#define B_REFERENCE_CLOCK_RESET BIT(0) > > +#define B_VIDEO_RESET BIT(1) > > +#define B_AUDIO_RESET BIT(2) > > +#define B_AUX_RESET BIT(3) > > +#define B_IPCLK_RESET BIT(4) > > +#define B_SDM_RESET BIT(5) > > +#define B_TCLK_RESET BIT(6) > > + > > +#define TX_REG_RESET_2_CTRL 0x06 > > + > > +#define TX_REG_V_STS 0x09 > > +#define B_RXSEN BIT(1) > > +#define B_V_STABLE BIT(2) > > +#define B_TMDS_STABLE BIT(3) > > + > > +#define TX_REG_SYS_CONFIG 0x0C > > +#define B_EN_HDMI BIT(6) > > +#define B_INT_POL BIT(0) > > +#define B_INT_MODE BIT(1) > > +#define B_INT_OUT_STATUS BIT(2) > > +#define B_INT_OUTPUT BIT(3) > > + > > +#define BIT_OFFSET(x) ((x) * BITS_PER_BYTE) > > + > > +#define TX_REG_INT1 0x10 > > +#define TX_REG_INT_MASK1 0x18 > > +#define INT_HPD_CHG 0 > > +#define B_HPD_CHG BIT(INT_HPD_CHG) > > +#define BIT_HPD_CHG (BIT_OFFSET(0) + INT_HPD_CHG) > > +#define INT_RXSEN_CHANGE 2 > > +#define B_RXSEN_CHANGE BIT(INT_RXSEN_CHANGE) > > +#define BIT_RXSEN_CHANGE (BIT_OFFSET(0) + INT_RXSEN_CHANGE) > > +#define INT_AUTH_F 3 > > +#define B_INT_AUTH_F BIT(INT_AUTH_F) > > +#define BIT_INT_AUTH_F (BIT_OFFSET(0) + INT_AUTH_F) > > +#define INT_AUTH_D 4 > > +#define B_INT_AUTH_D BIT(INT_AUTH_D) > > +#define BIT_INT_AUTH_D (BIT_OFFSET(0) + INT_AUTH_D) > > + > > +#define TX_REG_INT2 0x11 > > +#define TX_REG_INT_MASK2 0x19 > > +#define INT_KSV_CHECK 1 > > +#define B_KSV_CHECK BIT(INT_KSV_CHECK) > > +#define BIT_KSV_CHECK (BIT_OFFSET(1) + INT_KSV_CHECK) > > + > > +#define TX_REG_INT3 0x16 > > +#define TX_REG_INT_MASK3 0x1E > > +#define INT_TMDS_STB_CHG 6 > > +#define B_TMDS_STB_CHG BIT(INT_TMDS_STB_CHG) > > +#define BIT_TMDS_STB_CHG (BIT_OFFSET(2) + INT_TMDS_STB_CHG) > > + > > +#define REG_TX_INT_CTRL 0x21 > > +#define B_DIS_INT_OUTPUT BIT(5) > > +#define TX_REG_CLOCK_PWD_CTRL 0x2B > > + > > +#define TX_REG_AFE0E 0x0E > > +#define TX_REG_AFE30 0x30 > > +#define TX_REG_AFE33 0x33 > > +#define TX_REG_AFE34 0x34 > > +#define TX_REG_AFE35 0x35 > > +#define TX_REG_AFEE9 0xE9 > > +#define TX_REG_AFE_XP 0x219 > > +#define TX_REG_AFE_XLC1 0x220 > > +#define TX_REG_AFE_XLC2 0x223 > > +#define TX_REG_AFE_XLC3 0x226 > > +#define TX_REG_AFE_DRV 0x23B > > + > > +#define TX_REG_CR_1_CTRL 0x3A > > +#define TX_REG_CR_2_CTRL 0x3F > > + > > +#define TX_REG_R0TM 0x5A > > +#define TX_REG_SHA_SEL 0x5D > > + > > +#define TX_REG_HDCP_CTRL1 0x60 > > +#define B_CPDESIRED BIT(0) > > +#define TX_REG_HDCP_PRO 0x61 > > +#define B_AUTH_FIRE BIT(0) > > +#define B_LIST_CHK_DONE BIT(4) > > +#define B_LIST_CHK_FAIL BIT(5) > > +#define TX_REG_HDCP_CTRL2 0x62 > > +#define TX_REG_AUTOMUTE 0x65 > > +#define B_AN_SEL BIT(0) > > +#define B_EN_AN_GEN BIT(1) > > +#define B_EN_M0_RD BIT(5) > > +#define TX_REG_HDCP_AUTH_CS 0x66 > > +#define M_AUTH_CH 0x7F > > +#define CS_AUTH_DONE 0x4E > > +#define CS_AUTH_FAIL 0x02 > > +#define CS_KSVLIST_CHK 0x19 > > +#define TX_REG_HDCP_CTRL3 0x1BA > > +#define B_ENC_DIS BIT(6) > > +#define B_PAUSE BIT(7) > > + > > +#define TX_REG_VD_CTRL1 0xA8 > > +#define TX_REG_VD_CTRL2 0xA4 > > +#define B_VIDEO_FIFO_REST BIT(0) > > +#define TX_REG_VD_CTRL3 0xB7 > > + > > +#define TX_REG_AUD_SPDIF 0x23 > > +#define TX_REG_AUD_CTRL 0xB8 > > +#define TX_REG_AUD_FMT 0xBA > > +#define TX_REG_EN_AUDIO 0xBB > > +#define TX_REG_AUD_FIFO1 0xBC > > +#define TX_REG_AUD_FIFO2 0xBD > > +#define TX_REG_AUD_STS1 0x1F0 > > +#define B_EN_AUD_NLPCM BIT(1) > > +#define TX_REG_AUD_STS2 0x1F3 > > +#define TX_REG_AUD_STS3 0x1F4 > > + > > +#define TX_REG_LINK_CTRL0 0xD3 > > +#define B_EN_AUDIO_MUTE BIT(5) > > + > > +#define TX_REG_V_QUEUE 0xE7 > > +#define TX_REG_V_TU 0xEB > > + > > +#define TX_REG_HPD_CONFIG 0xF6 > > + > > +#define TX_REG_CEC_CONFIG 0xFA > > +#define B_EN_CEC BIT(0) > > + > > +#define TX_REG_DDC_CTRL1 0x1A0 > > +#define TX_REG_DDC_ADDR 0x1A1 > > +#define DDC_HDCP_ADDR (DRM_HDCP_DDC_ADDR << 1) > > +#define DDC_EDID_ADDR (DDC_ADDR << 1) > > +#define TX_REG_DDC_OFFSET 0x1A2 > > +#define TX_REG_DDC_NUM_L 0x1A3 > > +#define TX_REG_DDC_NUM_H 0x1A4 > > +#define TX_REG_DDC_SEGMENT 0x1A5 > > +#define TX_REG_DDC_COMMAND 0x1A6 > > +#define DDC_COMMAND_BURST_R 0X00 > > +#define DDC_COMMAND_BURST_W 0X01 > > +#define DDC_COMMAND_EDID_RD 0X03 > > +#define DDC_COMMAND_FIFO_CLR 0X09 > > +#define DDC_COMMAND_ABORT 0X0F > > +#define TX_REG_DDC_CTRL2 0x1AD > > +#define B_DDC_REST BIT(4) > > +#define TX_REG_DDC_STATUS 0x1A7 > > +#define B_DDC_TX_DONE BIT(7) > > +#define B_DDC_NOACK BIT(5) > > +#define B_DDC_FULL BIT(2) > > +#define TX_REG_DDC_FIFO 0x1A8 > > +#define TX_REG_DDC_FIFO_STS 0x1AE > > +#define M_DDC_STAGE_NUM 0x3F > > + > > +#define TX_REG_HDMI_CTRL1 0x1B8 > > +#define B_EN_HDMI_MODE BIT(0) > > +#define TX_REG_HDMI_CTRL2 0x1B9 > > +#define B_EN_AVMUTE BIT(0) > > +#define TX_REG_EN_PKT1 0x1BF > > +#define B_EN_AVI BIT(0) > > +#define B_AVI_RP BIT(1) > > +#define B_EN_AUD BIT(2) > > +#define B_EN_AUD_RP BIT(3) > > +#define TX_REG_EN_PKT2 0x1C0 > > +#define B_EN_GEN BIT(4) > > +#define B_GEN_RP BIT(5) > > + > > +#define TX_REG_VH_TIME 0x165 > > +#define TX_REG_PG_HFP_L 0x150 > > +#define TX_REG_PG_HFP_H 0x151 > > +#define TX_REG_PG_HSW_L 0x152 > > +#define TX_REG_PG_HSW_H 0x153 > > +#define TX_REG_PG_HBP_L 0x154 > > +#define TX_REG_PG_HBP_H 0x155 > > +#define TX_REG_PG_DEW_L 0x156 > > +#define TX_REG_PG_DEW_H 0x157 > > +#define TX_REG_PG_HVR2_L 0x158 > > +#define TX_REG_PG_HVR2_H 0x159 > > +#define TX_REG_PG_VFP_L 0x15A > > +#define TX_REG_PG_VFP_H 0x15B > > +#define TX_REG_PG_VSW_L 0x15C > > +#define TX_REG_PG_VSW_H 0x15D > > +#define TX_REG_PG_VBP_L 0x15E > > +#define TX_REG_PG_VBP_H 0x15F > > +#define TX_REG_PG_VDEW_L 0x160 > > +#define TX_REG_PG_HDEW_H 0x161 > > +#define TX_REG_PG_VFP2_L 0x162 > > +#define TX_REG_PG_VFP2_H 0x163 > > +#define TX_REG_PG_POL 0x164 > > + > > +#define TX_REG_AVIINFO_DB00 0x1D0 > > +#define TX_REG_AVIINFO_DB01 0x1D1 > > +#define TX_REG_AVIINFO_DB02 0x1D2 > > +#define TX_REG_AVIINFO_DB03 0x1D3 > > +#define TX_REG_AVIINFO_DB04 0x1D4 > > +#define TX_REG_AVIINFO_DB05 0x1D5 > > +#define TX_REG_AVIINFO_DB06 0x1D6 > > +#define TX_REG_AVIINFO_DB07 0x1D7 > > +#define TX_REG_AVIINFO_DB08 0x1D8 > > +#define TX_REG_AVIINFO_DB09 0x1D9 > > +#define TX_REG_AVIINFO_DB10 0x1DA > > +#define TX_REG_AVIINFO_DB11 0x1DB > > +#define TX_REG_AVIINFO_DB12 0x1DC > > +#define TX_REG_AVIINFO_DB13 0x1DD > > +#define TX_REG_AVIINFO_DB14 0x1DE > > + > > +#define TX_REG_AUDINFO_DB01 0x1E0 > > +#define TX_REG_AUDINFO_DB02 0x1E1 > > +#define TX_REG_AUDINFO_DB03 0x1E2 > > +#define TX_REG_AUDINFO_DB04 0x1E3 > > +#define TX_REG_AUDINFO_DB05 0x1E4 > > +#define TX_REG_AUDINFO_DB06 0x1E5 > > +#define TX_REG_AUDINFO_DB07 0x1E6 > > +#define TX_REG_AUDINFO_DB08 0x1E7 > > +#define TX_REG_AUDINFO_DB09 0x1E8 > > +#define TX_REG_AUDINFO_DB10 0x1E9 > > + > > +#define TX_REG_SSC_PD 0x211 > > + > > +#define TX_REG_TXPLL_CTRL 0x218 > > +#define TX_REG_XLC_7_CTRL 0x227 > > + > > +#define TX_REG_TXDRV_PD_CTRL 0x23D > > +#define TX_REG_TXDRV_CTRL 0x240 > > +#define TX_REG_AUX_CTRL 0x244 > > +#define TX_REG_IPLL_CTRL 0x248 > > +#define TX_REG_RDROM_TRG 0x271 > > + > > +#define TX_REG_HDCP_ARI_L 0x63 > > +#define TX_REG_HDCP_ARI_H 0x64 > > + > > +#define TX_REG_HDCP_AUTH_STS 0x67 > > + > > +#define TX_REG_HDCP_BKSV1 0x68 > > +#define TX_REG_HDCP_BKSV2 0x69 > > +#define TX_REG_HDCP_BKSV3 0x6A > > +#define TX_REG_HDCP_BKSV4 0x6B > > +#define TX_REG_HDCP_BKSV5 0x6C > > + > > +#define TX_REG_HDCP_BRI_L 0x6D > > +#define TX_REG_HDCP_BRI_H 0x6E > > + > > +#define TX_REG_HDCP_AKSV1 0x6F > > +#define TX_REG_HDCP_AKSV2 0x70 > > +#define TX_REG_HDCP_AKSV3 0x71 > > +#define TX_REG_HDCP_AKSV4 0x72 > > +#define TX_REG_HDCP_AKSV5 0x73 > > + > > +#define TX_REG_ANM0V1 0x74 > > +#define TX_REG_ANM0V2 0x75 > > +#define TX_REG_ANM0V3 0x76 > > +#define TX_REG_HDCP_AN_M0_V4 0x77 > > +#define TX_REG_HDCP_AN_M05 0x78 > > +#define TX_REG_HDCP_AN_M06 0x79 > > +#define TX_REG_HDCP_AN_M07 0x7A > > +#define TX_REG_HDCP_AN_M08 0x7B > > + > > +#define TX_REG_HDCP_BCAPS 0x7C > > +#define B_KSV_READY BIT(5) > > +#define TX_REG_HDCP_BSTS_L 0x7D > > +#define TX_REG_HDCP_BSTS_H 0x7E > > + > > +#define TX_REG_AUDPKT_CTS_0 0x3A8 > > +#define TX_REG_AUDPKT_CTS_1 0x3A9 > > +#define TX_REG_AUDPKT_CTS_2 0x3AA > > + > > +#define TX_REG_AUDPKT_N_0 0x3AB > > +#define TX_REG_AUDPKT_N_1 0x3AC > > +#define TX_REG_AUDPKT_N_2 0x3AD > > + > > +#define SOFT_DDC_TIMEOUT_MS 100 > > + > > +#define MAX_HDCP_DOWN_STREAM_COUNT 127 > > +#define HDCP_SHA1_FIFO_LEN (MAX_HDCP_DOWN_STREAM_COUNT * DRM_HDCP_KSV_LEN + 10) > > + > > +#define HI_BYTE(x) (((x) >> 8) & 0xFF) > > +#define LO_BYTE(x) ((x) & 0xFF) > > + > > +enum video_state { > > + it61620_VIDEO_OFF = 0x00, > > + it61620_VIDEO_WAIT, > > + it61620_VIDEO_ON, > > +}; > > + > > +enum hdcp_state { > > + CP_NONE = 0x00, > > + CP_GOING = 0x01, > > +}; > > + > > +enum it61620_audio_select { > > + I2S = 0, > > + SPDIF, > > +}; > > + > > +enum it61620_audio_word_length { > > + WORD_LENGTH_16BIT = 0x0, > > + WORD_LENGTH_18BIT = 0x1, > > + WORD_LENGTH_20BIT = 0x2, > > + WORD_LENGTH_24BIT = 0x3, > > +}; > > + > > +enum it61620_audio_sample_rate { > > + SAMPLE_RATE_32K = 0x3, > > + SAMPLE_RATE_48K = 0x2, > > + SAMPLE_RATE_64K = 0xB, > > + SAMPLE_RATE_96K = 0xA, > > + SAMPLE_RATE_192K = 0xE, > > + SAMPLE_RATE_44_1K = 0x0, > > + SAMPLE_RATE_88_2K = 0x8, > > + SAMPLE_RATE_176_4K = 0xC, > > +}; > > + > > +enum it61620_audio_type { > > + LPCM = 0, > > + NLPCM, > > +}; > > + > > +struct it6162_chip_info { > > + u16 vid; > > + u16 pid; > > +}; > > + > > +struct it61620_audio { > > + enum it61620_audio_select select; > > + enum it61620_audio_type type; > > + enum it61620_audio_sample_rate sample_rate; > > + u8 word_length; > > + u8 channel_count; > > + u8 audfmt; > > + unsigned int audio_enable; > > + unsigned int sample_width; > > + unsigned int channel_number; > > + u8 infoframe[HDMI_INFOFRAME_SIZE(AUDIO)]; > > + unsigned char channel_status[AES_IEC958_STATUS_SIZE]; > > +}; > > + > > +struct it61620_mipirx { > > + u8 lane_num; > > + u8 pn_swap; > > + u8 lane_swap; > > +}; > > + > > +struct it61620_hdmi_afe_setting { > > + unsigned int clock; > > + unsigned int h2on_pll; > > + unsigned int hs; > > + unsigned int afe_val[24]; > > +}; > > + > > +struct it61620_platform_data { > > + struct regulator *ovdd1833; > > + struct regulator *ivdd; > > + struct regulator *ovdd33; > > + struct gpio_desc *gpiod_reset; > > +}; > > + > > +struct it61620 { > > + struct drm_bridge bridge; > > + struct drm_connector connector; > > + struct device *dev; > > + enum drm_connector_status connector_status; > > + struct drm_device *drm; > > + struct drm_bridge *next_bridge; > > + > > + struct i2c_client *it61620_i2c; > > + struct i2c_client *mipirx_i2c; > > + struct i2c_client *tx_i2c; > > + struct regmap *it61620_regmap; > > + struct regmap *mipirx_regmap; > > + struct regmap *tx_regmap; > > + > > + struct delayed_work hdcp_work; > > + struct wait_queue_head wq; > > + > > + struct it61620_platform_data pdata; > > + bool powered; > > + bool is_hdmi; > > + bool en_audio; > > + bool hpd; > > + u8 dev_ver; > > + const struct drm_edid *cached_edid; > > + > > + /* operations can only be served one at the time */ > > + struct mutex ddc_lock; > > + > > + enum video_state video_state; > > + > > + struct it61620_audio audio_config; > > + > > + /* it61620 DSI RX related params */ > > + struct mipi_dsi_device *dsi; > > + > > + struct it61620_mipirx mipirx_config; > > + > > + struct videomode vm; > > + > > + struct i2c_adapter ddc; > > + > > + enum hdcp_state hdcp_state; > > + u8 sha1_input[HDCP_SHA1_FIFO_LEN]; > > + const struct it6162_chip_info *chip_info; > > +}; > > + > > +static void it61620_show_drm_video_mode(struct it61620 *it61620, > > + const struct videomode *vm); > > +static void it61620_stop_hdcp_work(struct it61620 *it61620); > > +static void it61620_start_hdcp_work(struct it61620 *it61620); > > +static void it61620_hdmi_hdcp_wait_ksv_list(struct it61620 *it61620); > > +static inline void it61620_hdmi_enable_avmute(struct it61620 *it61620, > > + bool enable); > > + > > +static struct it61620 *bridge_to_it61620(struct drm_bridge *bridge) > > +{ > > + return container_of(bridge, struct it61620, bridge); > > +} > > + > > +static const struct regmap_config it61620_regmap_config = { > > + .reg_bits = 8, > > + .val_bits = 8, > > + .max_register = 0xff, > > + .cache_type = REGCACHE_NONE, > > +}; > > + > > +static const struct regmap_range it61620_tx_volatile_ranges[] = { > > + { .range_min = 0, .range_max = 0x3ff}, > > +}; > > + > > +static const struct regmap_access_table it61620_tx_volatile_table = { > > + .yes_ranges = it61620_tx_volatile_ranges, > > + .n_yes_ranges = ARRAY_SIZE(it61620_tx_volatile_ranges), > > +}; > > + > > +static const struct regmap_range_cfg it61620_tx_regmap_ranges[] = { > > + { > > + .range_min = 0, > > + .range_max = 0x3ff, > > + .selector_reg = TX_REG_HDMITX_BANK, > > + .selector_mask = M_HDMITX_BANK, > > + .selector_shift = 0, > > + .window_start = 0x00, > > + .window_len = 0x100, > > + }, > > +}; > > + > > +static const struct regmap_config it61620_tx_regmap_config = { > > + .reg_bits = 8, > > + .val_bits = 8, > > + .volatile_table = &it61620_tx_volatile_table, > > + .ranges = it61620_tx_regmap_ranges, > > + .num_ranges = ARRAY_SIZE(it61620_tx_regmap_ranges), > > + .max_register = 0x3FF, > > + .cache_type = REGCACHE_NONE, > > +}; > > + > > +static const struct regmap_range it61620_mipirx_volatile_ranges[] = { > > + { .range_min = 0, .range_max = 0x1ff }, > > +}; > > + > > +static const struct regmap_access_table it61620_mipirx_volatile_table = { > > + .yes_ranges = it61620_mipirx_volatile_ranges, > > + .n_yes_ranges = ARRAY_SIZE(it61620_mipirx_volatile_ranges), > > +}; > > + > > +static const struct regmap_range_cfg it61620_mipirx_regmap_ranges[] = { > > + { > > + .range_min = 0, > > + .range_max = 0x1ff, > > + .selector_reg = RX_REG_BANK, > > + .selector_mask = M_MIPIRX_BANK, > > + .selector_shift = 0, > > + .window_start = 0x00, > > + .window_len = 0x100, > > + }, > > +}; > > + > > +static const struct regmap_config it61620_mipi_regmap_config = { > > + .reg_bits = 8, > > + .val_bits = 8, > > + .volatile_table = &it61620_mipirx_volatile_table, > > + .ranges = it61620_mipirx_regmap_ranges, > > + .num_ranges = ARRAY_SIZE(it61620_mipirx_regmap_ranges), > > + .max_register = 0x1FF, > > + .cache_type = REGCACHE_NONE, > > +}; > > + > > +static unsigned int it61620_mipi_reg_read(struct it61620 *it61620, > > + unsigned int reg) > > +{ > > + unsigned int val; > > + int err; > > + struct device *dev = it61620->dev; > > + > > + if (!it61620->powered) > > + return -ENODEV; > > + > > + err = regmap_read(it61620->mipirx_regmap, reg, &val); > > + if (err < 0) { > > + dev_err(dev, "read failed rx reg[0x%x] err: %d", reg, err); > > + return err; > > + } > > + > > + return val; > > +} > > + > > +static int it61620_mipi_reg_write(struct it61620 *it61620, unsigned int reg, > > + unsigned int val) > > +{ > > + int err; > > + struct device *dev = it61620->dev; > > + > > + if (!it61620->powered) > > + return -ENODEV; > > + > > + err = regmap_write(it61620->mipirx_regmap, reg, val); > > + > > + if (err < 0) { > > + dev_err(dev, "write failed rx reg[0x%x] = 0x%x err = %d", > > + reg, val, err); > > + return err; > > + } > > + > > + return 0; > > +} > > + > > +static int it61620_mipi_reg_set(struct it61620 *it61620, unsigned int reg, > > + unsigned int mask, unsigned int val) > > +{ > > + int err; > > + struct device *dev = it61620->dev; > > + > > + if (!it61620->powered) > > + return -ENODEV; > > + > > + err = regmap_update_bits(it61620->mipirx_regmap, reg, mask, val); > > + if (err < 0) { > > + dev_err(dev, > > + "write rx reg[0x%x] = 0x%x mask = 0x%x failed err %d", > > + reg, val, mask, err); > > + return err; > > + } > > + > > + return 0; > > +} > > + > > +static unsigned int it61620_hdmi_reg_read(struct it61620 *it61620, > > + unsigned int reg) > > +{ > > + unsigned int val; > > + int err; > > + struct device *dev = it61620->dev; > > + > > + if (!it61620->powered) > > + return -ENODEV; > > + > > + err = regmap_read(it61620->tx_regmap, reg, &val); > > + if (err < 0) { > > + dev_err(dev, "read failed tx reg[0x%x] err: %d", reg, err); > > + return err; > > + } > > + > > + return val; > > +} > > + > > +static int it61620_hdmi_reg_write(struct it61620 *it61620, unsigned int reg, > > + unsigned int val) > > +{ > > + int err; > > + struct device *dev = it61620->dev; > > + > > + if (!it61620->powered) > > + return -ENODEV; > > + > > + err = regmap_write(it61620->tx_regmap, reg, val); > > + > > + if (err < 0) { > > + dev_err(dev, "write failed tx reg[0x%x] = 0x%x err = %d", > > + reg, val, err); > > + return err; > > + } > > + > > + return 0; > > +} > > + > > +static int it61620_hdmi_reg_set(struct it61620 *it61620, unsigned int reg, > > + unsigned int mask, unsigned int val) > > +{ > > + int err; > > + struct device *dev = it61620->dev; > > + > > + if (!it61620->powered) > > + return -ENODEV; > > + > > + err = regmap_update_bits(it61620->tx_regmap, reg, mask, val); > > + if (err < 0) { > > + dev_err(dev, > > + "write tx reg[0x%x] = 0x%x mask = 0x%x failed err %d", > > + reg, val, mask, err); > > + return err; > > + } > > + > > + return 0; > > +} > > + > > +static void it61620_mipi_reset_video(struct it61620 *it61620) > > +{ > > + it61620_mipi_reg_write(it61620, RX_REG_DSC_RESET, 0x38); > > + usleep_range(100, 200); > > + it61620_mipi_reg_set(it61620, RX_REG_D2P_RESET, 0x70, 0x70); > > + it61620_mipi_reg_write(it61620, RX_REG_DSC_RESET, 0x00); > > + > > + it61620_mipi_reg_set(it61620, RX_REG_RESET_CTRL, 0x57, 0x00); > > + usleep_range(1000, 2000); > > +} > > + > > +static void it61620_mipi_m2p_reset(struct it61620 *it61620) > > +{ > > + if (it61620->dev_ver != DEV_VERSION_A0) > > + return; > > + it61620_mipi_reg_set(it61620, RX_REG_MIPI_CTRL02, B_FIFO_RST, > > + B_FIFO_RST); > > + usleep_range(1000, 2000); > > + it61620_mipi_reg_set(it61620, RX_REG_MIPI_CTRL02, B_FIFO_RST, 0x00); > > +} > > + > > +static void it61620_mipi_d2p_reset_fifo(struct it61620 *it61620) > > +{ > > + it61620_mipi_reg_set(it61620, RX_REG_D2P_RESET, 0x70, 0x70); > > + usleep_range(1000, 2000); > > + it61620_mipi_reg_set(it61620, RX_REG_D2P_RESET, 0x70, 0x50); > > + usleep_range(100, 200); > > + it61620_mipi_reg_set(it61620, RX_REG_D2P_RESET, 0x70, 0x10); > > + usleep_range(100, 200); > > + it61620_mipi_reg_set(it61620, RX_REG_D2P_RESET, 0x70, 0x00); > > +} > > + > > +static void it61620_mipi_d2p_reset(struct it61620 *it61620) > > +{ > > + it61620_mipi_m2p_reset(it61620); > > + it61620_mipi_reg_set(it61620, RX_REG_D_RST, B_D_RST, B_D_RST); > > + usleep_range(1000, 2000); > > + it61620_mipi_reg_set(it61620, RX_REG_D_RST, B_D_RST, 0x00); > > + it61620_mipi_d2p_reset_fifo(it61620); > > +} > > + > > +static void it61620_mipi_reset(struct it61620 *it61620) > > +{ > > + unsigned int val; > > + u8 dev_ver = it61620->dev_ver; > > + struct it61620_mipirx *mipirx = &it61620->mipirx_config; > > + > > + it61620_mipi_reg_set(it61620, RX_REG_RESET_CTRL, B_REF_CLOCK_RESET, > > + B_REF_CLOCK_RESET); > > + usleep_range(1000, 2000); > > + it61620_mipi_reg_set(it61620, RX_REG_RESET_CTRL, B_REF_CLOCK_RESET, > > + 0x00); > > + usleep_range(1000, 2000); > > + > > + it61620_mipi_d2p_reset(it61620); > > + > > + it61620_mipi_reg_write(it61620, RX_REG_HS_CTRL, 0x93); > > + it61620_mipi_reg_write(it61620, RX_REG_LP_CTRL, 0x0C); > > + it61620_mipi_reg_write(it61620, RX_REG_AUTO_SYNC, 0x01); > > + it61620_mipi_reg_write(it61620, RX_REG_MV_MAX, 0x0F); > > + it61620_mipi_reg_write(it61620, RX_REG_FORCE_M, B_FORCE_MHT_STB); > > + > > + it61620_mipi_reg_write(it61620, RX_REG_MIPI_CTRL01, 0x2C); > > + it61620_mipi_reg_write(it61620, RX_REG_AUTO_D2P_RESET, 0x13); > > + it61620_mipi_reg_write(it61620, RX_REG_D2P_CTRL, 0x28); > > + it61620_mipi_reg_write(it61620, RX_REG_TUNEOPT, 0x9C); > > + > > + it61620_mipi_reg_set(it61620, RX_REG_CLK_CTRL, 0x30, 0x20); > > + > > + if (dev_ver != DEV_VERSION_A0) { > > + it61620_mipi_reg_write(it61620, RX_REG_TUNETHRE, 0x02); > > + it61620_mipi_reg_write(it61620, RX_REG_AUTO_D2P_RESET, 0x83); > > + it61620_mipi_reg_set(it61620, RX_REG_FORCE_M, B_FORCE_MVT_STB, > > + B_FORCE_MVT_STB); > > + it61620_mipi_reg_set(it61620, RX_REG_SYNC_NUM, 0xF7, 0x44); > > + it61620_mipi_reg_set(it61620, RX_REG_BSP_SEL, 0x03, 0x02); > > + it61620_mipi_reg_set(it61620, RX_REG_PWD_CTRL, 0x24, 0x24); > > + it61620_mipi_reg_set(it61620, RX_REG_ENVRR, 0x01, 0x00); > > + it61620_mipi_reg_write(it61620, RX_REG_ENVBLK, 0x00); > > + it61620_mipi_reg_set(it61620, RX_REG_DSCCTRL, 0x40, 0x00); > > + } > > + val = (mipirx->lane_num - 1) | > > + (mipirx->pn_swap ? B_MIPI_PN_SWAP : 0x00) | > > + (mipirx->lane_swap ? B_MIPI_LANE_SWAP : 0x00); > > + > > + it61620_mipi_reg_set(it61620, RX_REG_MIPI_CONFIG, 0x0F, val); > > + > > + it61620_mipi_reset_video(it61620); > > +} > > + > > +static void it61620_mipi_video_change_irq(struct it61620 *it61620) > > +{ > > + unsigned int reg22; > > + unsigned int video_stable; > > + > > + reg22 = it61620_mipi_reg_read(it61620, RX_REG_INT_STATUS_02); > > + video_stable = reg22 & B_INI_V_STB; > > + > > + if (video_stable) { > > + it61620_mipi_m2p_reset(it61620); > > + it61620_mipi_d2p_reset_fifo(it61620); > > + } else { > > + it61620_mipi_reg_set(it61620, RX_REG_D_RST, 0x01, 0x01); > > + usleep_range(1000, 2000); > > + it61620_mipi_reg_set(it61620, RX_REG_D_RST, 0x01, 0x00); > > + it61620_mipi_reg_set(it61620, RX_REG_D2P_RESET, 0x70, 0x70); > > + } > > +} > > + > > +static void it61620_mipi_irq_handler(struct it61620 *it61620) > > +{ > > + unsigned int reg0a, reg_val; > > + > > + reg_val = it61620_mipi_reg_read(it61620, RX_REG_CLK_CTRL) & > > + B_MIPI_INT_STATUS; > > + if (reg_val == 0) > > + return; > > + > > + reg0a = it61620_mipi_reg_read(it61620, RX_REG_INT_STATUS_01); > > + it61620_mipi_reg_write(it61620, RX_REG_INT_STATUS_01, reg0a); > > + if (reg0a & B_INI_V_CHG) > > + it61620_mipi_video_change_irq(it61620); > > +} > > + > > +static void it61620_mipi_set_d2v_video_timing(struct it61620 *it61620) > > +{ > > + u8 seldckval; > > + u32 htotal, hfp, hsw, hbp, hdew; > > + u32 vfp, vsw, vbp, vdew; > > + u32 clock; > > + bool hpol_high = 0, vpol_high = 0; > > + struct videomode *vm = &it61620->vm; > > + > > + it61620_show_drm_video_mode(it61620, &it61620->vm); > > + > > + if (vm->flags & DISPLAY_FLAGS_HSYNC_HIGH) > > + hpol_high = true; > > + > > + if (vm->flags & DISPLAY_FLAGS_VSYNC_HIGH) > > + vpol_high = true; > > + > > + clock = vm->pixelclock / 1000; > > + hdew = vm->hactive; > > + > > + hfp = vm->hfront_porch; > > + hsw = vm->hsync_len; > > + hbp = vm->hback_porch; > > + htotal = vm->hactive + vm->hfront_porch + vm->hsync_len + > > + vm->hback_porch; > > + > > + vdew = vm->vactive; > > + vfp = vm->vfront_porch; > > + vsw = vm->vsync_len; > > + vbp = vm->vback_porch; > > + > > + if (it61620->dev_ver != DEV_VERSION_A0) { > > + if (it61620->dev_ver == DEV_VERSION_C0) { > > + seldckval = 0x04; > > + } else { > > + if (clock > 270000) > > + seldckval = 0x0C; > > + else > > + seldckval = 0x18; > > + } > > + it61620_mipi_reg_set(it61620, RX_REG_SELDCLK, 0x1C, seldckval); > > + } > > + > > + if (hdew > 2000) > > + it61620_mipi_reg_write(it61620, RX_REG_DSC_VFRD, 0x50); > > + else > > + it61620_mipi_reg_write(it61620, RX_REG_DSC_VFRD, hdew / 36); > > + > > + it61620_mipi_reg_write(it61620, RX_REG_HFP_L, LO_BYTE(hfp)); > > + it61620_mipi_reg_write(it61620, RX_REG_HFP_H, HI_BYTE(hfp)); > > + > > + it61620_mipi_reg_write(it61620, RX_REG_HSW_L, LO_BYTE(hsw)); > > + it61620_mipi_reg_write(it61620, RX_REG_HSW_H, HI_BYTE(hsw)); > > + > > + it61620_mipi_reg_write(it61620, RX_REG_HBP_L, LO_BYTE(hbp)); > > + it61620_mipi_reg_write(it61620, RX_REG_HBP_H, HI_BYTE(hbp)); > > + > > + it61620_mipi_reg_write(it61620, RX_REG_HDEW_L, LO_BYTE(hdew)); > > + it61620_mipi_reg_write(it61620, RX_REG_HDEW_H, HI_BYTE(hdew)); > > + > > + it61620_mipi_reg_write(it61620, RX_REG_HTOTAL_L, LO_BYTE(htotal)); > > + it61620_mipi_reg_write(it61620, RX_REG_HTOTAL_H, HI_BYTE(htotal)); > > + > > + it61620_mipi_reg_write(it61620, RX_REG_VFP_L, LO_BYTE(vfp)); > > + it61620_mipi_reg_write(it61620, RX_REG_VFP_H, HI_BYTE(vfp)); > > + > > + it61620_mipi_reg_write(it61620, RX_REG_VSW_L, LO_BYTE(vsw)); > > + it61620_mipi_reg_write(it61620, RX_REG_VSW_H, HI_BYTE(vsw)); > > + > > + it61620_mipi_reg_write(it61620, RX_REG_VBP_L, LO_BYTE(vbp)); > > + it61620_mipi_reg_write(it61620, RX_REG_VBP_H, HI_BYTE(vbp)); > > + > > + it61620_mipi_reg_write(it61620, RX_REG_VDEW_L, LO_BYTE(vdew)); > > + it61620_mipi_reg_write(it61620, RX_REG_VDEW_H, HI_BYTE(vdew)); > > + > > + it61620_mipi_reg_set(it61620, RX_REG_POL, 0x03, ((!vpol_high) << 1) | > > + (!hpol_high)); > > + > > + if (it61620->dev_ver == DEV_VERSION_A0 && > > + ((hdew == 2560 && vdew == 1440 && clock == 241500) || > > + (hdew == 720 && vdew == 400 && clock == 28320) || > > + (hdew == 720 && vdew == 576 && clock == 27000))) { > > Why are these modes special? How do we make sure we're not missing any > modes that require extra operations? These issues were found on the first engineering sample, DEV_VERSION_A0, and have been fixed in the newer IC revision. The new IC version will undergo comprehensive testing for verification. > > > + dev_dbg(it61620->dev, "device A0 %dx%d %d Khz", > > + hdew, vdew, clock); > > + it61620_mipi_reg_set(it61620, RX_REG_MPPCLKI, 0x80, 0x80); > > + it61620_hdmi_reg_set(it61620, TX_REG_VH_TIME, 0x48, 0x48); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_PG_HFP_L, LO_BYTE(hfp)); > > + it61620_hdmi_reg_write(it61620, TX_REG_PG_HFP_H, HI_BYTE(hfp)); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_PG_HSW_L, LO_BYTE(hsw)); > > + it61620_hdmi_reg_write(it61620, TX_REG_PG_HSW_H, HI_BYTE(hsw)); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_PG_HBP_L, LO_BYTE(hbp)); > > + it61620_hdmi_reg_write(it61620, TX_REG_PG_HBP_H, HI_BYTE(hbp)); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_PG_DEW_L, LO_BYTE(hdew)); > > + it61620_hdmi_reg_write(it61620, TX_REG_PG_DEW_H, HI_BYTE(hdew)); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_PG_HVR2_L, 0xFF); > > + it61620_hdmi_reg_write(it61620, TX_REG_PG_HVR2_H, 0x0F); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_PG_VFP_L, LO_BYTE(vfp)); > > + it61620_hdmi_reg_write(it61620, TX_REG_PG_VFP_H, HI_BYTE(vfp)); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_PG_VSW_L, LO_BYTE(vsw)); > > + it61620_hdmi_reg_write(it61620, TX_REG_PG_VSW_H, HI_BYTE(vsw)); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_PG_VBP_L, LO_BYTE(vbp)); > > + it61620_hdmi_reg_write(it61620, TX_REG_PG_VBP_H, HI_BYTE(vbp)); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_PG_VDEW_L, LO_BYTE(vdew)); > > + it61620_hdmi_reg_write(it61620, TX_REG_PG_HDEW_H, HI_BYTE(vdew)); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_PG_VFP2_L, 0xFF); > > + it61620_hdmi_reg_write(it61620, TX_REG_PG_VFP2_H, 0x0F); > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_PG_POL, 0x07, > > + ((vpol_high) << 1) | (hpol_high)); > > + > > + } else { > > + it61620_mipi_reg_set(it61620, RX_REG_MPPCLKI, 0x80, 0x00); > > + it61620_hdmi_reg_set(it61620, TX_REG_VH_TIME, 0x48, 0x00); > > + } > > + > > + it61620_mipi_d2p_reset(it61620); > > +} > > + > > +static void it61620_hdmi_reset(struct it61620 *it61620) > > +{ > > + it61620_hdmi_reg_set(it61620, TX_REG_RESET_1_CTRL, 0x7E, 0x7E); > > + it61620_hdmi_reg_set(it61620, TX_REG_RESET_2_CTRL, 0x36, 0x36); > > + usleep_range(1000, 2000); > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_RESET_1_CTRL, 0x1F, 0x00); > > + usleep_range(1000, 2000); > > + it61620_hdmi_reg_set(it61620, TX_REG_RESET_1_CTRL, 0x40, 0x00); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_RDROM_TRG, 0x04); > > + usleep_range(1000, 2000); > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_SYS_CONFIG, B_EN_HDMI, B_EN_HDMI); > > + > > + /* Reset AFE */ > > + it61620_hdmi_reg_set(it61620, TX_REG_XLC_7_CTRL, 0x04, 0x00); > > + it61620_hdmi_reg_set(it61620, TX_REG_IPLL_CTRL, 0x02, 0x00); > > + it61620_hdmi_reg_set(it61620, TX_REG_TXPLL_CTRL, 0x04, 0x00); > > + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_CTRL, 0x01, 0x00); > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_XLC_7_CTRL, 0x04, 0x04); > > + it61620_hdmi_reg_set(it61620, TX_REG_IPLL_CTRL, 0x02, 0x02); > > + it61620_hdmi_reg_set(it61620, TX_REG_TXPLL_CTRL, 0x04, 0x04); > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_CTRL, 0x01, 0x01); > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_CTRL, 0x08, 0x08); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_V_QUEUE, 0x08); > > + it61620_hdmi_reg_write(it61620, TX_REG_V_TU, 0x07); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_CR_1_CTRL, 0x09); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_CR_2_CTRL, 0x16); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_VD_CTRL1, 0x04); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_HDCP_CTRL2, 0x04); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_VD_CTRL3, 0x84); > > + it61620_hdmi_reg_write(it61620, TX_REG_HPD_CONFIG, 0x06); > > + usleep_range(1000, 2000); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_VD_CTRL2, 0x2E); > > + it61620_hdmi_reg_write(it61620, TX_REG_HDMI_CTRL1, 0x30); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_HDMI_CTRL2, 0x04); > > +} > > + > > +static void it61620_hdmi_poweron(struct it61620 *it61620) > > +{ > > + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_PD_CTRL, 0x70, 0x00); > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_XLC_7_CTRL, 0x07, 0x06); > > + it61620_hdmi_reg_set(it61620, TX_REG_IPLL_CTRL, 0x12, 0x12); > > + it61620_hdmi_reg_set(it61620, TX_REG_TXPLL_CTRL, 0xc6, 0x84); > > + it61620_hdmi_reg_set(it61620, TX_REG_SSC_PD, 0x03, 0x03); > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_CLOCK_PWD_CTRL, 0x0F, 0x00); > > + it61620_hdmi_reg_set(it61620, TX_REG_VD_CTRL2, B_VIDEO_FIFO_REST, > > + B_VIDEO_FIFO_REST); > > + usleep_range(1000, 2000); > > + it61620_hdmi_reg_set(it61620, TX_REG_VD_CTRL2, B_VIDEO_FIFO_REST, 0x00); > > +} > > + > > +static void it61620_hdmi_powerdown(struct it61620 *it61620) > > +{ > > + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_PD_CTRL, 0x70, 0x70); > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_SSC_PD, 0x03, 0x00); > > + it61620_hdmi_reg_set(it61620, TX_REG_IPLL_CTRL, 0x12, 0x00); > > + it61620_hdmi_reg_set(it61620, TX_REG_TXPLL_CTRL, 0xc6, 0xc2); > > + it61620_hdmi_reg_set(it61620, TX_REG_XLC_7_CTRL, 0x07, 0x01); > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_CTRL, 0xf9, 0x00); > > + it61620_hdmi_reg_set(it61620, TX_REG_AUX_CTRL, 0x90, 0x00); > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_CLOCK_PWD_CTRL, 0x0F, 0x0a); > > + it61620_hdmi_reg_set(it61620, TX_REG_CEC_CONFIG, B_EN_CEC, 0x00); > > +} > > + > > +static bool it61620_hdmi_get_hpd_status(struct it61620 *it61620) > > +{ > > + int val; > > + > > + val = it61620_hdmi_reg_read(it61620, TX_REG_STATUS01); > > + if (val < 0) > > + return false; > > + > > + return !!(val & B_HPD_STATUS); > > +} > > + > > +static void it61620_hdmi_ddc_abort(struct it61620 *it61620) > > +{ > > + struct drm_device *drm = it61620->drm; > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_DDC_CTRL2, B_DDC_REST, B_DDC_REST); > > + usleep_range(1000, 2000); > > + it61620_hdmi_reg_set(it61620, TX_REG_DDC_CTRL2, B_DDC_REST, 0x00); > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, DDC_COMMAND_ABORT); > > + usleep_range(1000, 2000); > > + drm_dbg(drm, "tx ddc ststus %02X\n", > > + it61620_hdmi_reg_read(it61620, TX_REG_DDC_STATUS)); > > +} > > + > > +static int it61620_hdmi_ddc_wait(struct it61620 *it61620) > > +{ > > + struct drm_device *drm = it61620->drm; > > + unsigned int ddc_status; > > + int ret = 0; > > + unsigned long timeout; > > + > > + timeout = jiffies + msecs_to_jiffies(SOFT_DDC_TIMEOUT_MS) + 1; > > + > > + for (;;) { > > + usleep_range(1000, 2000); > > + ddc_status = it61620_hdmi_reg_read(it61620, TX_REG_DDC_STATUS); > > + > > + if (ddc_status & B_DDC_NOACK) { > > + drm_dbg(drm, "DDC no ack"); > > + ret = -EIO; > > + break; > > + } > > + > > + if (ddc_status & B_DDC_TX_DONE) > > + break; > > + > > + if (ddc_status & B_DDC_FULL) { > > + drm_dbg(drm, "DDC FULL"); > > + break; > > + } > > + > > + if (time_after(jiffies, timeout)) { > > + drm_dbg(drm, "DDC SOFT timeout %x\n", ddc_status); > > + ret = -ETIMEDOUT; > > + break; > > + } > > + } > > + > > + return ret; > > +} > > Can we re-write this function with readx_poll_timeout() or > regmap_read_poll_timeout()? > > To use readx_poll_timeout(), you might need to introduce a dedicated > function for reading TX_REG_DDC_STATUS. anx7625.c has some example > usages with this. > > To use regmap_read_poll_timeout(), you will have to handle the checked > in it61620_hdmi_reg_read() here. > The next version will switch to using readx_poll_timeout(). > > + > > +static int it61620_hdmi_get_ddc_fifo(struct it61620 *it61620, u8 *buf, > > + size_t len) > > +{ > > + int err; > > + struct device *dev = it61620->dev; > > + > > + if (!it61620->powered) > > + return -ENODEV; > > + > > + err = regmap_bulk_read(it61620->tx_regmap, TX_REG_DDC_FIFO, buf, len); > > + if (err < 0) { > > + dev_err(dev, "read ddc fifo failed tx reg[0x%x] err = %d", > > + TX_REG_DDC_FIFO, err); > > + return err; > > + } > > + > > + return 0; > > +} > > + > > +static int it61620_hdmi_set_ddc_fifo(struct it61620 *it61620, u8 *buf, > > + size_t len) > > +{ > > + int err; > > + struct device *dev = it61620->dev; > > + > > + if (!it61620->powered) > > + return -ENODEV; > > + > > + err = regmap_bulk_write(it61620->tx_regmap, TX_REG_DDC_FIFO, buf, len); > > + if (err < 0) { > > + dev_err(dev, "write ddc fifo failed tx reg[0x%x] err = %d", > > + TX_REG_DDC_FIFO, err); > > + return err; > > + } > > + > > + return 0; > > +} > > + > > +static const struct it61620_hdmi_afe_setting hdmi_afe[4] = { > > + {375000, 0x01, 0x02, > > + {0x03, 0x53, 0x1A, 0x03, 0x00, 0x04, > > + 0x03, 0x53, 0x1A, 0x03, 0x00, 0x04, > > + 0x03, 0x53, 0x1A, 0x03, 0x00, 0x04, > > + 0x01, 0x4B, 0x0F, 0x00, 0x07, 0x04}}, > > + {340000, 0x01, 0x02, > > + {0x03, 0x53, 0x1A, 0x03, 0x00, 0x04, > > + 0x03, 0x53, 0x1A, 0x03, 0x00, 0x04, > > + 0x03, 0x53, 0x1A, 0x03, 0x00, 0x04, > > + 0x01, 0x4B, 0x0F, 0x00, 0x07, 0x04}}, > > + {150000, 0x00, 0x00, > > + {0x03, 0x43, 0x18, 0x03, 0x00, 0x04, > > + 0x03, 0x43, 0x18, 0x03, 0x00, 0x04, > > + 0x03, 0x43, 0x18, 0x03, 0x00, 0x04, > > + 0x03, 0x43, 0x18, 0x03, 0x00, 0x04}}, > > + {0, 0x00, 0x00, > > + {0x03, 0x43, 0x18, 0x03, 0x00, 0x04, > > + 0x03, 0x43, 0x18, 0x03, 0x00, 0x04, > > + 0x03, 0x43, 0x18, 0x03, 0x00, 0x04, > > + 0x03, 0x43, 0x18, 0x03, 0x00, 0x04}} > > +}; > > + > > +static void it61620_hdmi_setup_afe(struct it61620 *it61620, int clock) > > +{ > > + int i; > > + unsigned int reg_ofset; > > + const struct it61620_hdmi_afe_setting *afe; > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_AFE30, 0x1F, 0x07); > > + it61620_hdmi_reg_write(it61620, TX_REG_AFEE9, 0x10); > > + it61620_hdmi_reg_write(it61620, TX_REG_AFE33, 0x00); > > + it61620_hdmi_reg_write(it61620, TX_REG_AFE34, 0xE4); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_AFE35, 0x00); > > + it61620_hdmi_reg_write(it61620, TX_REG_AFEE9, 0x10); > > + > > + for (i = 0; i < sizeof(hdmi_afe); i++) { > > + if (clock > hdmi_afe[i].clock || hdmi_afe[i].clock == 0) > > + break; > > + } > > + > > + afe = &hdmi_afe[i]; > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_AFE0E, 0xF0); > > + > > + if (clock > 100000) > > + it61620_hdmi_reg_set(it61620, TX_REG_TXPLL_CTRL, 0x19, 0x08); > > + else > > + it61620_hdmi_reg_set(it61620, TX_REG_TXPLL_CTRL, 0x19, 0x11); > > + > > + if (afe->h2on_pll) { > > + it61620_hdmi_reg_write(it61620, TX_REG_AFE_XP, 0x48); > > + it61620_hdmi_reg_set(it61620, TX_REG_AFE_XLC1, 0x87, 0x81); > > + it61620_hdmi_reg_set(it61620, TX_REG_AFE_XLC2, 0x40, 0x00); > > + it61620_hdmi_reg_write(it61620, TX_REG_AFE_XLC3, 0x32); > > + it61620_hdmi_reg_set(it61620, TX_REG_XLC_7_CTRL, 0xFF, 0xB6); > > + } else { > > + it61620_hdmi_reg_write(it61620, TX_REG_AFE_XP, 0x00); > > + } > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_AFE_DRV, 0x00); > > + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_CTRL, 0x02, afe->hs); > > + > > + for (i = 0, reg_ofset = 0x280; reg_ofset <= 0x297; reg_ofset++) > > + it61620_hdmi_reg_write(it61620, reg_ofset, afe->afe_val[i++]); > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_INT_MASK3, B_TMDS_STB_CHG, > > + B_TMDS_STB_CHG); > > +} > > + > > +static inline void it61620_hdmi_fire_afe(struct it61620 *it61620) > > +{ > > + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_CTRL, 0xF1, 0xF1); > > +} > > + > > +static inline void it61620_hdmi_disable_afe(struct it61620 *it61620) > > +{ > > + it61620_hdmi_reg_set(it61620, TX_REG_TXDRV_CTRL, 0xF1, 0x00); > > +} > > + > > +static int it61620_hdmi_hdcprd(struct it61620 *it61620, int offset, int bytenum) > > +{ > > + int ret = 0; > > + > > + guard(mutex)(&it61620->ddc_lock); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, > > + DDC_COMMAND_FIFO_CLR); > > + usleep_range(1000, 2000); > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_ADDR, DDC_HDCP_ADDR); > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_OFFSET, offset); > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_NUM_L, bytenum); > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_NUM_H, (bytenum & 0x300) >> 8); > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, DDC_COMMAND_BURST_R); > > + > > + if (it61620_hdmi_ddc_wait(it61620) < 0) { > > + it61620_hdmi_ddc_abort(it61620); > > + ret = -EIO; > > + dev_dbg(it61620->dev, "ddc fail"); > > + } > > + return ret; > > +} > > + > > +static int it61620_hdmi_hdcp_ksvlist_rd(struct it61620 *it61620, > > + unsigned int bytenum, u8 *out) > > +{ > > + int ret = 0; > > + unsigned int i; > > + unsigned int count; > > + > > + guard(mutex)(&it61620->ddc_lock); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, DDC_COMMAND_FIFO_CLR); > > + usleep_range(1000, 2000); > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_ADDR, DDC_HDCP_ADDR); > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_OFFSET, 0x43); > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_NUM_L, bytenum); > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_NUM_H, (bytenum & 0x300) >> 8); > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, DDC_COMMAND_BURST_R); > > + > > + for (i = 0; i < bytenum;) { > > + if (it61620_hdmi_ddc_wait(it61620) < 0) { > > + it61620_hdmi_ddc_abort(it61620); > > + ret = -EIO; > > + dev_dbg(it61620->dev, "ddc fail"); > > + break; > > + } > > + > > + count = it61620_hdmi_reg_read(it61620, TX_REG_DDC_FIFO_STS) & > > + M_DDC_STAGE_NUM; > > + it61620_hdmi_get_ddc_fifo(it61620, (out + i), count); > > + i += count; > > + } > > + > > + return ret; > > +} > > + > > +static int it61620_hdmi_enable_hdcp(struct it61620 *it61620) > > +{ > > + struct drm_device *drm = it61620->drm; > > + unsigned int sts, auth_cs; > > + > > + sts = it61620_hdmi_reg_read(it61620, TX_REG_V_STS); > > + if ((sts & B_TMDS_STABLE) != B_TMDS_STABLE) { > > + drm_dbg(drm, "TMDS not stable, stop hdcp %x", sts); > > + return false; > > + } > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL3, B_ENC_DIS, B_ENC_DIS); > > + usleep_range(1000, 2000); > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_RESET_2_CTRL, 0x10, 0x10); > > + usleep_range(1000, 2000); > > + it61620_hdmi_reg_set(it61620, TX_REG_RESET_2_CTRL, 0x10, 0x00); > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_R0TM, 0xC0, 0x40); > > + it61620_hdmi_reg_write(it61620, TX_REG_SHA_SEL, 0x00); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_AUTOMUTE, 0x00); > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL2, B_AN_SEL, B_AN_SEL); > > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL2, B_EN_AN_GEN, > > + B_EN_AN_GEN); > > + usleep_range(1000, 2000); > > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL2, B_EN_AN_GEN, 0x00); > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL1, B_CPDESIRED, > > + B_CPDESIRED); > > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL3, (B_PAUSE | B_ENC_DIS), > > + 0x00); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_HDCP_PRO, B_AUTH_FIRE); > > + > > + /* > > + * HDCP start requires 100ms for the first part of the authentication > > + * protocol,20ms is used to wait for 61620 HW completion. > > + */ > > + if (wait_event_timeout(it61620->wq, !it61620->hpd, msecs_to_jiffies(120))) > > + return false; > > + > > + auth_cs = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_AUTH_CS) & M_AUTH_CH; > > + if (auth_cs == CS_KSVLIST_CHK) { > > + it61620_hdmi_hdcp_wait_ksv_list(it61620); > > + usleep_range(1000, 2000); > > + auth_cs = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_AUTH_CS) & > > + M_AUTH_CH; > > + } > > + > > + if (auth_cs == CS_AUTH_DONE) { > > + it61620_hdmi_enable_avmute(it61620, false); > > + it61620_hdmi_reg_set(it61620, TX_REG_INT1, B_INT_AUTH_F, > > + B_INT_AUTH_F); > > + it61620_hdmi_reg_set(it61620, TX_REG_INT_MASK1, B_INT_AUTH_F, > > + B_INT_AUTH_F); > > + drm_dbg(drm, "auth done"); > > + return true; > > + } > > + > > + drm_dbg(drm, "auth fail"); > > + it61620_hdmi_enable_avmute(it61620, true); > > + return false; > > +} > > + > > +static void it61620_hdmi_reset_hdcp(struct it61620 *it61620) > > +{ > > + it61620_hdmi_reg_set(it61620, TX_REG_INT_MASK1, > > + (B_INT_AUTH_D | B_INT_AUTH_F), 0x00); > > + it61620_hdmi_reg_set(it61620, TX_REG_INT_MASK2, B_KSV_CHECK, 0x00); > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL3, B_ENC_DIS, B_ENC_DIS); > > + usleep_range(1000, 2000); > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_RESET_2_CTRL, 0x18, 0x18); > > + usleep_range(1000, 2000); > > + it61620_hdmi_reg_set(it61620, TX_REG_RESET_2_CTRL, 0x18, 0x00); > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL1, B_CPDESIRED, > > + B_CPDESIRED); > > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL3, > > + (B_PAUSE | B_ENC_DIS), B_PAUSE); > > + it61620_hdmi_reg_write(it61620, TX_REG_AUTOMUTE, 0x00); > > +} > > + > > +static bool it61620_hdmi_hdcp_is_ksv_valid(u8 *ksv) > > +{ > > + int i, ones = 0; > > + > > + if ((ksv[4] == 0x93 && ksv[3] == 0x43 && ksv[2] == 0x5C && > > + ksv[1] == 0xDE && ksv[0] == 0x23) || > > + (ksv[4] == 0x7D && ksv[3] == 0xB4 && ksv[2] == 0x21 && > > + ksv[1] == 0x37 && ksv[0] == 0x0B)) > > + return false; > > + > > + /* KSV has 20 1's and 20 0's */ > > + for (i = 0; i < 5; i++) > > + ones += hweight8(ksv[i]); > > + > > + return ones == 20; > > +} > > + > > +static void it61620_hdmi_disable_hdcp(struct it61620 *it61620) > > +{ > > + it61620_hdmi_reset_hdcp(it61620); > > +} > > + > > +static int it61620_hdmi_start_hdcp(struct it61620 *it61620) > > +{ > > + struct drm_device *drm = it61620->drm; > > + u8 rx_hdmi_mode; > > + u8 bksv[DRM_HDCP_KSV_LEN]; > > + bool retcheck; > > + > > + if (it61620_hdmi_hdcprd(it61620, DRM_HDCP_DDC_BSTATUS, > > + DRM_HDCP_BSTATUS_LEN) < 0) { > > + drm_dbg(drm, "read bstatus fail!\n"); > > + return false; > > + } > > + > > + rx_hdmi_mode = (it61620_hdmi_reg_read(it61620, 0x7E) & 0x10) >> 4; > > + if (it61620->is_hdmi != rx_hdmi_mode) > > + return false; > > + > > + it61620_hdmi_hdcprd(it61620, DRM_HDCP_DDC_BKSV, DRM_HDCP_KSV_LEN); > > + bksv[0] = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_BKSV1); > > + bksv[1] = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_BKSV2); > > + bksv[2] = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_BKSV3); > > + bksv[3] = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_BKSV4); > > + bksv[4] = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_BKSV5); > > + retcheck = it61620_hdmi_hdcp_is_ksv_valid(bksv); > > + if (!retcheck) { > > + drm_dbg(drm, "ksv valid!\n"); > > + return false; > > + } > > + > > + if (drm_hdcp_check_ksvs_revoked(drm, bksv, 1) > 0) > > + return false; > > + > > + return it61620_hdmi_enable_hdcp(it61620); > > +} > > + > > +static int it61620_hdmi_sha1_digest(struct it61620 *it61620, u8 *sha1_input, > > + unsigned int size, u8 *output_av) > > +{ > > + struct shash_desc *desc; > > + struct crypto_shash *tfm; > > + int err; > > + struct drm_device *drm = it61620->drm; > > + > > + tfm = crypto_alloc_shash("sha1", 0, 0); > > + if (IS_ERR(tfm)) { > > + drm_dbg(drm, "crypto_alloc_shash sha1 failed"); > > + return PTR_ERR(tfm); > > + } > > + desc = kzalloc(sizeof(*desc) + crypto_shash_descsize(tfm), GFP_KERNEL); > > + if (!desc) { > > + crypto_free_shash(tfm); > > + return -ENOMEM; > > + } > > + > > + desc->tfm = tfm; > > + err = crypto_shash_digest(desc, sha1_input, size, output_av); > > + if (err) > > + drm_dbg(drm, "crypto_shash_digest sha1 failed"); > > + > > + crypto_free_shash(tfm); > > + kfree(desc); > > + return err; > > +} > > + > > +static int it61620_hdmi_setup_sha1_input(struct it61620 *it61620, u8 *input) > > +{ > > + struct drm_device *drm = it61620->drm; > > + u8 bstatus[2]; > > + int down_stream_count, i, count = 0; > > + > > + it61620_hdmi_hdcprd(it61620, DRM_HDCP_DDC_BSTATUS, DRM_HDCP_BSTATUS_LEN); > > + bstatus[0] = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_BSTS_L); > > + bstatus[1] = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_BSTS_H); > > + > > + down_stream_count = DRM_HDCP_NUM_DOWNSTREAM(bstatus[0]); > > + if (DRM_HDCP_MAX_DEVICE_EXCEEDED(bstatus[0]) || > > + DRM_HDCP_MAX_CASCADE_EXCEEDED(bstatus[1])) { > > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL3, > > + (B_PAUSE | B_ENC_DIS), B_PAUSE); > > + return 0; > > + } > > + > > + if (!down_stream_count || > > + down_stream_count > MAX_HDCP_DOWN_STREAM_COUNT) { > > + drm_dbg(drm, "HDCP down stream count Error %d", > > + down_stream_count); > > + return 0; > > + } > > + drm_dbg(drm, "down stream count %d\n", down_stream_count); > > + > > + count = down_stream_count * DRM_HDCP_KSV_LEN; > > + it61620_hdmi_hdcp_ksvlist_rd(it61620, count, input); > > + if (drm_hdcp_check_ksvs_revoked(drm, input, down_stream_count) > 0) > > + return 0; > > + > > + input[count++] = bstatus[0]; > > + input[count++] = bstatus[1]; > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_SHA_SEL, 0x70, 0x70); > > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL2, B_EN_M0_RD, B_EN_M0_RD); > > + for (i = 0; i < 8; i++) > > + input[count++] = it61620_hdmi_reg_read(it61620, > > + (TX_REG_ANM0V1 + i)); > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL2, B_EN_M0_RD, 0x00); > > + > > + return count; > > +} > > + > > +static bool it61620_hdmi_hdcp_part2_ksvlist_check(struct it61620 *it61620) > > +{ > > + struct drm_device *drm = it61620->drm; > > + u8 av[5][4], bv[5][4]; > > + int i, j; > > + > > + i = it61620_hdmi_setup_sha1_input(it61620, it61620->sha1_input); > > + if (i <= 0) > > + return false; > > + > > + it61620_hdmi_sha1_digest(it61620, it61620->sha1_input, i, (u8 *)av); > > + > > + for (i = 0; i < DRM_HDCP_V_PRIME_NUM_PARTS; i++) { > > + it61620_hdmi_hdcprd(it61620, DRM_HDCP_DDC_V_PRIME(i), > > + DRM_HDCP_V_PRIME_PART_LEN); > > + it61620_hdmi_reg_set(it61620, TX_REG_HDCP_CTRL2, > > + B_EN_M0_RD, B_EN_M0_RD); > > + it61620_hdmi_reg_set(it61620, TX_REG_SHA_SEL, 0x70, (i << 4)); > > + > > + for (j = 0; j < DRM_HDCP_V_PRIME_PART_LEN; j++) > > + bv[i][j] = it61620_hdmi_reg_read(it61620, > > + TX_REG_ANM0V1 + j); > > + } > > + > > + for (i = 0; i < DRM_HDCP_V_PRIME_NUM_PARTS; i++) > > + if (bv[i][3] != av[i][0] || bv[i][2] != av[i][1] || > > + bv[i][1] != av[i][2] || bv[i][0] != av[i][3]) > > + break; > > + > > + if (i == DRM_HDCP_V_PRIME_NUM_PARTS) > > + return true; > > + > > + drm_dbg(drm, "V' Not match!!"); > > + return false; > > +} > > + > > +static void it61620_hdmi_hdcp_wait_ksv_list(struct it61620 *it61620) > > +{ > > + u8 bcaps = 0; > > + unsigned long timeout; > > + > > + timeout = jiffies + msecs_to_jiffies(5000) + 1; > > + for (;;) { > > + usleep_range(1000, 2000); > > + it61620_hdmi_hdcprd(it61620, DRM_HDCP_DDC_BCAPS, 1); > > + bcaps = it61620_hdmi_reg_read(it61620, TX_REG_HDCP_BCAPS); > > + if (bcaps & B_KSV_READY) > > + break; > > + > > + if (it61620->hdcp_state != CP_GOING) > > + break; > > + > > + if (time_after(jiffies, timeout)) > > + break; > > + } > > + > > + if ((bcaps & B_KSV_READY) && > > + it61620_hdmi_hdcp_part2_ksvlist_check(it61620)) { > > + it61620_hdmi_reg_write(it61620, TX_REG_HDCP_PRO, > > + B_LIST_CHK_DONE); > > + return; > > + } > > + it61620_hdmi_reg_write(it61620, TX_REG_HDCP_PRO, > > + B_LIST_CHK_DONE | B_LIST_CHK_FAIL); > > +} > > + > > +static void it61620_remove_edid(struct it61620 *it61620) > > +{ > > + drm_edid_free(it61620->cached_edid); > > + it61620->cached_edid = NULL; > > +} > > + > > +static void it61620_hdmi_irq_hdcp_auth_fail(struct it61620 *it61620) > > +{ > > + struct drm_device *drm = it61620->drm; > > + > > + if (it61620->hdcp_state == CP_GOING) { > > + it61620_hdmi_enable_avmute(it61620, true); > > + drm_dbg(drm, "auth fail after done, set avmute"); > > + it61620_start_hdcp_work(it61620); > > + } > > +} > > + > > +static void it61620_hdmi_irq_hpd(struct it61620 *it61620) > > +{ > > + it61620->hpd = it61620_hdmi_get_hpd_status(it61620); > > + > > + if (!it61620->hpd) { > > + wake_up(&it61620->wq); > > + it61620_stop_hdcp_work(it61620); > > + it61620_hdmi_disable_afe(it61620); > > + it61620_remove_edid(it61620); > > + } else if (it61620->video_state == it61620_VIDEO_ON) { > > + it61620_hdmi_fire_afe(it61620); > > + it61620_start_hdcp_work(it61620); > > + } > > +} > > + > > +static void it61620_hdmi_irq_rxsen_chg(struct it61620 *it61620) > > +{ > > + unsigned int rxsen; > > + > > + if (!it61620_hdmi_get_hpd_status(it61620)) > > + return; > > + > > + rxsen = it61620_hdmi_reg_read(it61620, TX_REG_V_STS) & B_RXSEN; > > + if (it61620->video_state == it61620_VIDEO_ON) { > > + if (rxsen) { > > + it61620_hdmi_fire_afe(it61620); > > + it61620_start_hdcp_work(it61620); > > + } else { > > + it61620_stop_hdcp_work(it61620); > > + it61620_hdmi_disable_afe(it61620); > > + } > > + } > > +} > > + > > +static void it61620_hdmi_irq_TMDS_stb_change(struct it61620 *it61620) > > +{ > > + unsigned int video_status; > > + > > + video_status = it61620_hdmi_reg_read(it61620, TX_REG_V_STS); > > + > > + if (video_status & B_TMDS_STABLE) > > + it61620_start_hdcp_work(it61620); > > +} > > + > > +static bool it61620_test_bit(unsigned int bit, const unsigned int *addr) > > +{ > > + return 1 & (addr[bit / BITS_PER_BYTE] >> (bit % BITS_PER_BYTE)); > > +} > > + > > +static void it61620_hdmi_interrupt_handler(struct it61620 *it61620) > > +{ > > + unsigned int int_status[3], i; > > + static const struct { > > + int bit; > > + void (*handler)(struct it61620 *it61620); > > + } irq_vec[] = { > > + { BIT_HPD_CHG, it61620_hdmi_irq_hpd }, > > + { BIT_RXSEN_CHANGE, it61620_hdmi_irq_rxsen_chg }, > > + { BIT_INT_AUTH_F, it61620_hdmi_irq_hdcp_auth_fail }, > > + { BIT_TMDS_STB_CHG, it61620_hdmi_irq_TMDS_stb_change }, > > + }; > > + > > + int_status[0] = it61620_hdmi_reg_read(it61620, TX_REG_INT1); > > + int_status[1] = it61620_hdmi_reg_read(it61620, TX_REG_INT2); > > + int_status[2] = it61620_hdmi_reg_read(it61620, TX_REG_INT3); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_INT1, int_status[0]); > > + it61620_hdmi_reg_write(it61620, TX_REG_INT2, int_status[1]); > > + it61620_hdmi_reg_write(it61620, TX_REG_INT3, int_status[2]); > > + > > + for (i = 0; i < ARRAY_SIZE(irq_vec); i++) { > > + if (it61620_test_bit(irq_vec[i].bit, (unsigned int *)int_status)) > > + irq_vec[i].handler(it61620); > > + } > > +} > > + > > +static void it61620_hdmi_irq(struct it61620 *it61620) > > +{ > > + unsigned int reg_val; > > + > > + reg_val = it61620_hdmi_reg_read(it61620, TX_REG_HDMITX_BANK); > > + if (reg_val & B_INT_EVENT_HDMI) > > + it61620_hdmi_interrupt_handler(it61620); > > +} > > + > > +static void it61620_hdmi_audio_set_ncts(struct it61620 *it61620, > > + unsigned int sample_rate) > > +{ > > + unsigned int n, cts; > > + > > + drm_hdmi_acr_get_n_cts(it61620->vm.pixelclock, sample_rate, &n, &cts); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_AUDPKT_N_0, (u8)((n) & 0xFF)); > > + it61620_hdmi_reg_write(it61620, TX_REG_AUDPKT_N_1, > > + (u8)((n >> 8) & 0xFF)); > > + it61620_hdmi_reg_write(it61620, TX_REG_AUDPKT_N_2, > > + (u8)((n >> 16) & 0x0F)); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_AUDPKT_CTS_0, (u8)((cts) & 0xFF)); > > + it61620_hdmi_reg_write(it61620, TX_REG_AUDPKT_CTS_1, > > + (u8)((cts >> 8) & 0xFF)); > > + it61620_hdmi_reg_write(it61620, TX_REG_AUDPKT_CTS_2, > > + (u8)((cts >> 16) & 0x0F)); > > +} > > + > > +static inline void it61620_hdmi_disable_audio_infoframe(struct it61620 *it61620) > > +{ > > + it61620_hdmi_reg_set(it61620, TX_REG_EN_PKT1, > > + (B_EN_AUD | B_EN_AUD_RP), 0x00); > > +} > > + > > +static inline void it61620_hdmi_enable_audio_infoframe(struct it61620 *it61620) > > +{ > > + it61620_hdmi_reg_set(it61620, TX_REG_EN_PKT1, (B_EN_AUD | B_EN_AUD_RP), > > + (B_EN_AUD | B_EN_AUD_RP)); > > +} > > + > > +static inline void it61620_hdmi_disable_avi_infoframe(struct it61620 *it61620) > > +{ > > + it61620_hdmi_reg_set(it61620, TX_REG_EN_PKT1, > > + (B_EN_AVI | B_AVI_RP), 0x00); > > +} > > + > > +static inline void it61620_hdmi_enable_avi_infoframe(struct it61620 *it61620) > > +{ > > + it61620_hdmi_reg_set(it61620, TX_REG_EN_PKT1, (B_EN_AVI | B_AVI_RP), > > + (B_EN_AVI | B_AVI_RP)); > > +} > > + > > +static inline void it61620_hdmi_enable_hdmi_mode(struct it61620 *it61620) > > +{ > > + it61620_hdmi_reg_set(it61620, TX_REG_HDMI_CTRL1, B_EN_HDMI_MODE, > > + B_EN_HDMI_MODE); > > +} > > + > > +static inline void it61620_hdmi_enable_DVI_mode(struct it61620 *it61620) > > +{ > > + it61620_hdmi_reg_set(it61620, TX_REG_HDMI_CTRL1, B_EN_HDMI_MODE, 0x00); > > +} > > + > > +static inline void it61620_hdmi_enable_avmute(struct it61620 *it61620, > > + bool enable) > > +{ > > + it61620_hdmi_reg_set(it61620, TX_REG_HDMI_CTRL2, B_EN_AVMUTE, enable); > > +} > > + > > +static void it61620_hdmi_avi_infoframe_set(struct it61620 *it61620, > > + const u8 *buffer, size_t len) > > +{ > > + struct drm_device *drm = it61620->drm; > > + const u8 *ptr; > > + u8 i; > > + > > + drm_dbg(drm, "avinfo set\n"); > > + it61620_hdmi_disable_avi_infoframe(it61620); > > + > > + it61620_hdmi_enable_hdmi_mode(it61620); > > + /* fill PB */ > > + ptr = buffer + HDMI_INFOFRAME_HEADER_SIZE; > > + for (i = 0; i < len - HDMI_INFOFRAME_HEADER_SIZE; i++) > > + it61620_hdmi_reg_write(it61620, TX_REG_AVIINFO_DB01 + i, ptr[i]); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_AVIINFO_DB14, buffer[3]); > > + > > + /* Enable */ > > + it61620_hdmi_enable_avi_infoframe(it61620); > > +} > > + > > +static void it61620_hdmi_config_output(struct it61620 *it61620) > > +{ > > + struct drm_device *drm = it61620->drm; > > + > > + it61620_hdmi_reset(it61620); > > + it61620_hdmi_poweron(it61620); > > + it61620_hdmi_reg_set(it61620, TX_REG_HDMI_CTRL2, 0x70, 0x00); > > + if (it61620->is_hdmi) { > > + drm_dbg(drm, "HDMI\n"); > > + it61620_hdmi_enable_hdmi_mode(it61620); > > + it61620_hdmi_reg_set(it61620, TX_REG_EN_PKT2, > > + (B_EN_GEN | B_GEN_RP), > > + (B_EN_GEN | B_GEN_RP)); > > + } else { > > + drm_dbg(drm, "DVI\n"); > > + it61620_hdmi_enable_DVI_mode(it61620); > > + it61620_hdmi_reg_write(it61620, TX_REG_EN_PKT2, 0x00); > > + it61620_hdmi_reg_write(it61620, TX_REG_EN_PKT1, 0x00); > > + } > > + > > + it61620_hdmi_enable_avmute(it61620, false); > > + it61620_hdmi_setup_afe(it61620, it61620->vm.pixelclock / 1000); > > + it61620_hdmi_fire_afe(it61620); > > + it61620->video_state = it61620_VIDEO_ON; > > +} > > + > > +static int it61620_hdmi_audio_infoframe_set(struct it61620 *it61620, > > + const u8 *buffer, size_t len) > > +{ > > + u8 i; > > + const u8 *ptr; > > + > > + it61620_hdmi_disable_audio_infoframe(it61620); > > + > > + /* fill PB */ > > + ptr = buffer + HDMI_INFOFRAME_HEADER_SIZE; > > + for (i = 0; i < len - HDMI_INFOFRAME_HEADER_SIZE; i++) > > + it61620_hdmi_reg_write(it61620, TX_REG_AUDINFO_DB01 + i, ptr[i]); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_AUDINFO_DB06, buffer[3]); > > + it61620_hdmi_reg_write(it61620, TX_REG_AUDINFO_DB07, 0x00); > > + it61620_hdmi_reg_write(it61620, TX_REG_AUDINFO_DB08, 0x00); > > + it61620_hdmi_reg_write(it61620, TX_REG_AUDINFO_DB09, 0x00); > > + it61620_hdmi_reg_write(it61620, TX_REG_AUDINFO_DB10, 0x00); > > + > > + /* Enable */ > > + it61620_hdmi_enable_audio_infoframe(it61620); > > + return 0; > > +} > > + > > +static void it61620_start_hdcp_work(struct it61620 *it61620) > > +{ > > + it61620->hdcp_state = CP_GOING; > > + queue_delayed_work(system_wq, &it61620->hdcp_work, > > + msecs_to_jiffies(2400)); > > +} > > + > > +static void it61620_stop_hdcp_work(struct it61620 *it61620) > > +{ > > + it61620->hdcp_state = CP_NONE; > > + cancel_delayed_work_sync(&it61620->hdcp_work); > > + it61620_hdmi_disable_hdcp(it61620); > > +} > > + > > +static void it61620_hw_reset(struct it61620 *it61620) > > +{ > > + struct it61620_platform_data *pdata = &it61620->pdata; > > + > > + if (!pdata->gpiod_reset) > > + return; > > + > > + gpiod_set_value_cansleep(pdata->gpiod_reset, 1); > > + > > + usleep_range(10000, 20000); > > + gpiod_set_value_cansleep(pdata->gpiod_reset, 0); > > + usleep_range(10000, 20000); > > +} > > + > > +static int it61620_enable_devices(struct it61620 *it61620) > > +{ > > + struct device *dev = &it61620->it61620_i2c->dev; > > + unsigned int device_id[5]; > > + unsigned int i, vid, pid; > > + > > + regmap_write(it61620->it61620_regmap, REG_CTRL_PW, 0x55); > > + regmap_write(it61620->it61620_regmap, REG_CTRL_PW, 0xAA); > > + regmap_write(it61620->it61620_regmap, REG_CTRL_PW, 0xC3); > > + regmap_write(it61620->it61620_regmap, REG_CTRL_PW, 0xA5); > > + usleep_range(1000, 2000); > > + > > + for (i = 0; i < 5; i++) > > + device_id[i] = it61620_mipi_reg_read(it61620, > > + REG_VENDER_ID_L + i); > > + > > + dev_dbg(dev, "IT61620 ver %02X", device_id[4]); > > + > > + vid = (device_id[1] << 8) | device_id[0]; > > + pid = (device_id[3] << 8) | device_id[2]; > > + > > + if (vid != it61620->chip_info->vid || > > + pid != it61620->chip_info->pid) { > > + dev_err(dev, "vid %X != %X", > > + vid, it61620->chip_info->vid); > > + dev_err(dev, "pid %X != %X", > > + pid, it61620->chip_info->pid); > > + > > + return -ENODEV; > > + } > > + > > + it61620->dev_ver = device_id[4]; > > + return 0; > > +} > > + > > +static void it61620_int_setup(struct it61620 *it61620) > > +{ > > + /* SET INT# to Active Low open-drain */ > > + it61620_mipi_reg_set(it61620, RX_REG_INT_POL, 0x08, 0x08); > > + it61620_hdmi_reg_set(it61620, TX_REG_SYS_CONFIG, 0x0F, B_INT_MODE); > > + it61620_hdmi_reg_set(it61620, REG_TX_INT_CTRL, B_DIS_INT_OUTPUT, 0x00); > > +} > > + > > +static void it61620_int_enable(struct it61620 *it61620) > > +{ > > + it61620_hdmi_reg_set(it61620, TX_REG_INT_MASK1, B_HPD_CHG, B_HPD_CHG); > > +} > > + > > +static int it61620_reset_init(struct it61620 *it61620) > > +{ > > + it61620_hw_reset(it61620); > > + > > + if (it61620_enable_devices(it61620) < 0) > > + return -ENODEV; > > + > > + it61620_mipi_reset(it61620); > > + it61620_hdmi_reset(it61620); > > + it61620_int_setup(it61620); > > + it61620_int_enable(it61620); > > + it61620_hdmi_powerdown(it61620); > > + > > + return 0; > > +} > > + > > +static int it61620_poweron(struct it61620 *it61620) > > +{ > > + struct it61620_platform_data *pdata = &it61620->pdata; > > + struct drm_device *drm = it61620->drm; > > + struct device *dev = it61620->dev; > > + int err; > > + > > + if (it61620->powered) { > > + drm_dbg(drm, "Already powered on"); > > + return 0; > > + } > > + > > + err = regulator_enable(pdata->ivdd); > > + if (err) { > > + dev_err(dev, "Failed to enable IVDD: %d", err); > > + goto poweron_exit; > > + } > > + > > + err = regulator_enable(pdata->ovdd1833); > > + if (err) { > > + dev_err(dev, "Failed to enable OVDD1833: %d", err); > > + goto disable_ivdd; > > + } > > + > > + err = regulator_enable(pdata->ovdd33); > > + if (err) { > > + dev_err(dev, "Failed to enable OVDD33: %d", err); > > + goto disable_ovdd1833; > > + } > > + > > + gpiod_set_value_cansleep(pdata->gpiod_reset, 1); > > + usleep_range(10000, 20000); > > + gpiod_set_value_cansleep(pdata->gpiod_reset, 0); > > + usleep_range(10000, 20000); > > + > > + err = it61620_reset_init(it61620); > > + if (err < 0) > > + goto disable_ovdd33; > > + > > + it61620->powered = true; > > + it61620->hpd = it61620_hdmi_get_hpd_status(it61620); > > + if (it61620->it61620_i2c->irq) { > > + enable_irq(it61620->it61620_i2c->irq); > > + drm_dbg(drm, "enable irq %d\n", > > + it61620->it61620_i2c->irq); > > + } > > + drm_dbg(drm, "it61620 poweron end\n"); > > + return 0; > > + > > +disable_ovdd33: > > + regulator_disable(pdata->ovdd33); > > +disable_ovdd1833: > > + regulator_disable(pdata->ovdd1833); > > +disable_ivdd: > > + regulator_disable(pdata->ivdd); > > +poweron_exit: > > + return err; > > +} > > + > > +static int it61620_poweroff(struct it61620 *it61620) > > +{ > > + struct it61620_platform_data *pdata = &it61620->pdata; > > + struct drm_device *drm = it61620->drm; > > + struct device *dev = it61620->dev; > > + int err; > > + > > + if (!it61620->powered) { > > + drm_dbg(drm, "Already powered off"); > > + return 0; > > + } > > + > > + if (it61620->it61620_i2c->irq) { > > + disable_irq(it61620->it61620_i2c->irq); > > + drm_dbg(drm, "disable irq %d\n", > > + it61620->it61620_i2c->irq); > > + } > > + > > + gpiod_set_value_cansleep(pdata->gpiod_reset, 1); > > + > > + err = regulator_disable(pdata->ovdd33); > > + if (err) > > + dev_err(dev, "Failed to disable ovdd33: %d", err); > > + > > + err = regulator_disable(pdata->ivdd); > > + if (err) > > + dev_err(dev, "Failed to disable IVDD: %d", err); > > + > > + usleep_range(2000, 3000); > > + > > + err = regulator_disable(pdata->ovdd1833); > > + if (err) > > + dev_err(dev, "Failed to disable ovdd1833: %d", err); > > + > > + it61620->powered = false; > > + it61620->hpd = false; > > + it61620->connector_status = connector_status_disconnected; > > + it61620_remove_edid(it61620); > > + drm_dbg(drm, "it61620 poweroff\n"); > > + > > + return 0; > > +} > > + > > +static void it61620_config_default(struct it61620 *it61620) > > +{ > > + struct it61620_mipirx *mipirx = &it61620->mipirx_config; > > + struct it61620_audio *audio_config = &it61620->audio_config; > > + > > + mipirx->lane_num = 4; > > + mipirx->pn_swap = 0; > > + mipirx->lane_swap = 0; > > + it61620->connector_status = connector_status_disconnected; > > + > > + audio_config->select = I2S; > > + audio_config->sample_rate = SAMPLE_RATE_48K; > > + audio_config->type = LPCM; > > + audio_config->word_length = WORD_LENGTH_16BIT; > > + audio_config->channel_count = 2; > > + audio_config->audfmt = 0; > > +} > > + > > +static void it61620_show_drm_video_mode(struct it61620 *it61620, > > + const struct videomode *vm) > > +{ > > + struct drm_device *drm = it61620->drm; > > + > > + drm_dbg(drm, "HActive = %u\n", vm->hactive); > > + drm_dbg(drm, "VActive = %u\n", vm->vactive); > > + drm_dbg(drm, "HTotal = %u\n", > > + vm->hactive + vm->hfront_porch + vm->hsync_len + > > + vm->hback_porch); > > + drm_dbg(drm, "VTotal = %u\n", > > + vm->vactive + vm->vfront_porch + vm->vsync_len + > > + vm->vback_porch); > > + drm_dbg(drm, "PCLK = %lukhz\n", vm->pixelclock / 1000); > > + drm_dbg(drm, "HFP = %u\n", vm->hfront_porch); > > + drm_dbg(drm, "HSW = %u\n", vm->hsync_len); > > + drm_dbg(drm, "HBP = %u\n", vm->hback_porch); > > + drm_dbg(drm, "VFP = %u\n", vm->vfront_porch); > > + drm_dbg(drm, "VSW = %u\n", vm->vsync_len); > > + drm_dbg(drm, "VBP = %u\n", vm->vback_porch); > > + if (vm->flags & DISPLAY_FLAGS_HSYNC_HIGH) > > + drm_dbg(drm, "HPOL +\n"); > > + else > > + drm_dbg(drm, "HPOL -\n"); > > + > > + if (vm->flags & DISPLAY_FLAGS_VSYNC_HIGH) > > + drm_dbg(drm, "VPOL +\n"); > > + else > > + drm_dbg(drm, "VPOL -\n"); > > + > > + if (vm->flags & DISPLAY_FLAGS_INTERLACED) > > + drm_dbg(drm, "Intelaced\n"); > > + else > > + drm_dbg(drm, "Progressive\n"); > > +} > > + > > +static enum drm_mode_status it61620_mode_valid(struct it61620 *it61620, > > + const struct drm_display_mode *mode) > > +{ > > + if (mode->clock > 300000) > > + return MODE_CLOCK_HIGH; > > + > > + return MODE_OK; > > +} > > + > > +static int it61620_get_edid_block(void *data, u8 *buf, unsigned int block, > > + size_t len) > > +{ > > + struct it61620 *it61620 = data; > > + unsigned int edid_offset; > > + unsigned int cnt; > > + unsigned int i; > > + int ret = 0; > > + > > + if (len > EDID_LENGTH) > > + return -EINVAL; > > + > > + guard(mutex)(&it61620->ddc_lock); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, DDC_COMMAND_FIFO_CLR); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_ADDR, DDC_EDID_ADDR); > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_SEGMENT, block / 2); > > + > > + cnt = 0; > > + edid_offset = block * 128; > > + > > + for (i = 0; i < EDID_LENGTH; i += EDID_R_BURST_NUM, > > + edid_offset += EDID_R_BURST_NUM, > > + cnt += EDID_R_BURST_NUM) { > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_OFFSET, edid_offset); > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_SEGMENT, block >> 1); > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_NUM_L, > > + EDID_R_BURST_NUM); > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_NUM_H, > > + (EDID_R_BURST_NUM >> 8)); > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, > > + DDC_COMMAND_EDID_RD); > > + > > + if (it61620_hdmi_ddc_wait(it61620) < 0) { > > + it61620_hdmi_ddc_abort(it61620); > > + ret = -EIO; > > + break; > > + } > > + > > + it61620_hdmi_get_ddc_fifo(it61620, &buf[cnt], EDID_R_BURST_NUM); > > + } > > + > > + return ret; > > +} > > + > > +static void it61620_set_capability_from_edid_parse(struct it61620 *it61620, > > + const struct edid *edid) > > +{ > > + struct drm_device *drm = it61620->drm; > > + > > + it61620->is_hdmi = drm_detect_hdmi_monitor(edid); > > + it61620->en_audio = drm_detect_monitor_audio(edid); > > + > > + drm_dbg(drm, "%s mode, monitor %ssupport audio", > > + it61620->is_hdmi ? "HDMI" : "DVI", > > + it61620->en_audio ? "" : "not "); > > +} > > + > > +static int it61620_ddc_xfer_write(struct it61620 *it61620, > > + u8 *buf, unsigned int num) > > +{ > > + it61620_hdmi_set_ddc_fifo(it61620, buf, num); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, DDC_COMMAND_BURST_W); > > + if (it61620_hdmi_ddc_wait(it61620) < 0) { > > + it61620_hdmi_ddc_abort(it61620); > > + return -EIO; > > + } > > + > > + return num; > > +} > > + > > +static int it61620_ddc_xfer_read(struct it61620 *it61620, u8 *buf, > > + unsigned int num) > > +{ > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, DDC_COMMAND_BURST_R); > > + if (it61620_hdmi_ddc_wait(it61620) < 0) { > > + it61620_hdmi_ddc_abort(it61620); > > + return -EIO; > > + } > > + it61620_hdmi_get_ddc_fifo(it61620, buf, num); > > + return num; > > +} > > + > > +static int it61620_ddc_xfer(struct it61620 *it61620, struct i2c_msg *msgs) > > +{ > > + int ret; > > + > > + if (msgs->len > DDC_FIFO_DEPTH) > > + return -EINVAL; > > + > > + guard(mutex)(&it61620->ddc_lock); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_COMMAND, DDC_COMMAND_FIFO_CLR); > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_ADDR, msgs->addr << 1); > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_OFFSET, 0); > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_NUM_L, msgs->len); > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_NUM_H, (msgs->len >> 8)); > > + it61620_hdmi_reg_write(it61620, TX_REG_DDC_SEGMENT, 0); > > + > > + if ((msgs->flags & I2C_M_RD) == 0) > > + ret = it61620_ddc_xfer_write(it61620, msgs->buf, msgs->len); > > + else > > + ret = it61620_ddc_xfer_read(it61620, msgs->buf, msgs->len); > > + > > + return ret; > > +} > > + > > +static void it61620_enable_audio(struct it61620 *it61620) > > +{ > > + it61620_hdmi_reg_set(it61620, TX_REG_RESET_2_CTRL, 0x01, 0x00); > > +} > > + > > +static void it61620_disable_audio(struct it61620 *it61620) > > +{ > > + it61620_hdmi_reg_set(it61620, TX_REG_RESET_2_CTRL, 0x01, 0x01); > > + it61620_hdmi_reg_set(it61620, TX_REG_LINK_CTRL0, > > + B_EN_AUDIO_MUTE, B_EN_AUDIO_MUTE); > > +} > > + > > +static void it61620_config_audio(struct it61620 *it61620) > > +{ > > + struct it61620_audio *config = &it61620->audio_config; > > + struct drm_device *drm = it61620->drm; > > + u8 audsrc; > > + > > + drm_dbg(drm, "sample rate %d", config->sample_rate); > > + drm_dbg(drm, "sample width %d", config->sample_width); > > + drm_dbg(drm, "fmt %d", config->select); > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_AUD_FMT, 0x7F, > > + (config->word_length << 5) | config->audfmt); > > + if (config->select == SPDIF) { > > + it61620_hdmi_reg_write(it61620, TX_REG_AUD_FIFO1, 0x00); > > + it61620_hdmi_reg_write(it61620, TX_REG_AUD_FIFO2, 0x00); > > + it61620_hdmi_reg_set(it61620, TX_REG_AUD_SPDIF, 0x0F, 0x02); > > + it61620_hdmi_reg_write(it61620, TX_REG_AUD_CTRL, 0X01); > > + } else { > > + it61620_hdmi_reg_write(it61620, TX_REG_AUD_FIFO1, 0x10); > > + it61620_hdmi_reg_write(it61620, TX_REG_AUD_FIFO2, 0x32); > > + it61620_hdmi_reg_write(it61620, TX_REG_AUD_CTRL, 0X00); > > + } > > + > > + if (config->type == LPCM) > > + it61620_hdmi_reg_write(it61620, TX_REG_AUD_STS1, 0x00); > > + else > > + it61620_hdmi_reg_write(it61620, TX_REG_AUD_STS1, B_EN_AUD_NLPCM); > > + it61620_hdmi_reg_write(it61620, TX_REG_AUD_STS2, (config->sample_rate)); > > + it61620_hdmi_reg_write(it61620, TX_REG_AUD_STS3, > > + ((~(config->sample_rate << 4)) & 0xF0) + 0x0B); > > + > > + switch (config->channel_count) { > > + case 2: > > + audsrc = 0x01; > > + break; > > + case 3: > > + audsrc = 0x03; > > + break; > > + case 4: > > + audsrc = 0x03; > > + break; > > + case 5: > > + audsrc = 0x07; > > + break; > > + case 6: > > + audsrc = 0x07; > > + break; > > + case 7: > > + audsrc = 0x0f; > > + break; > > + case 8: > > + audsrc = 0x0f; > > + break; > > + default: > > + drm_dbg(drm, > > + "Error: Audio Channel Number Error !!!\n"); > > + audsrc = 0x01; > > + break; > > + } > > + > > + it61620_hdmi_reg_write(it61620, TX_REG_EN_AUDIO, audsrc); > > + > > + it61620_hdmi_reg_set(it61620, TX_REG_LINK_CTRL0, B_EN_AUDIO_MUTE, 0x00); > > + it61620_hdmi_reg_set(it61620, TX_REG_RESET_2_CTRL, 0x01, 0x00); > > +} > > + > > +static irqreturn_t it61620_int_threaded_handler(int unused, void *data) > > +{ > > + struct it61620 *it61620 = data; > > + struct device *dev = it61620->dev; > > + > > + pm_runtime_get_sync(dev); > > + > > + it61620_mipi_irq_handler(it61620); > > + it61620_hdmi_irq(it61620); > > + > > + pm_runtime_mark_last_busy(dev); > > + pm_runtime_put_autosuspend(dev); > > + > > + return IRQ_HANDLED; > > +} > > + > > +static int it61620_audio_update_hw_params(struct it61620 *it61620, > > + struct hdmi_codec_daifmt *fmt, > > + struct hdmi_codec_params *hparms) > > +{ > > + struct it61620_audio *config = &it61620->audio_config; > > + > > + memcpy(config->channel_status, &hparms->iec.status[0], > > + AES_IEC958_STATUS_SIZE); > > + > > + config->channel_number = hparms->channels; > > + > > + switch (hparms->sample_rate) { > > + case 32000: > > + config->sample_rate = SAMPLE_RATE_32K; > > + break; > > + case 44100: > > + config->sample_rate = SAMPLE_RATE_44_1K; > > + break; > > + case 48000: > > + config->sample_rate = SAMPLE_RATE_48K; > > + break; > > + case 88200: > > + config->sample_rate = SAMPLE_RATE_88_2K; > > + break; > > + case 96000: > > + config->sample_rate = SAMPLE_RATE_96K; > > + break; > > + case 176400: > > + config->sample_rate = SAMPLE_RATE_176_4K; > > + break; > > + case 192000: > > + config->sample_rate = SAMPLE_RATE_192K; > > + break; > > + default: > > + return -EINVAL; > > + } > > + > > + switch (hparms->sample_width) { > > + case 16: > > + config->sample_width = WORD_LENGTH_16BIT; > > + break; > > + case 24: > > + config->sample_width = WORD_LENGTH_18BIT; > > + break; > > + case 18: > > + config->sample_width = WORD_LENGTH_20BIT; > > + break; > > + case 20: > > + config->sample_width = WORD_LENGTH_24BIT; > > + break; > > + default: > > + return -EINVAL; > > + } > > + > > + switch (fmt->fmt) { > > + case HDMI_I2S: > > + config->select = I2S; > > + break; > > + case HDMI_SPDIF: > > + config->select = SPDIF; > > + break; > > + default: > > + return -EINVAL; > > + } > > + > > + it61620_hdmi_audio_set_ncts(it61620, hparms->sample_rate); > > + it61620_config_audio(it61620); > > + return 0; > > +} > > + > > +static void it61620_hdcp_work(struct work_struct *work) > > +{ > > + struct it61620 *it61620 = container_of(work, struct it61620, > > + hdcp_work.work); > > + it61620_hdmi_reset_hdcp(it61620); > > + if (!it61620_hdmi_start_hdcp(it61620) && > > + it61620->hdcp_state == CP_GOING) { > > + it61620_hdmi_disable_hdcp(it61620); > > + it61620_start_hdcp_work(it61620); > > + } > > +} > > + > > +static int it61620_hdmi_i2c_xfer(struct i2c_adapter *adap, > > + struct i2c_msg *msgs, int num) > > +{ > > + struct it61620 *it61620 = i2c_get_adapdata(adap); > > + struct device *dev = it61620->dev; > > + int i, j; > > + > > + for (i = 0 ; i < num ; i++) { > > + dev_dbg(dev, > > + " msg [%d] addr = %X, flag = %X, len = %d\n", > > + i, msgs[i].addr, msgs[i].flags, msgs[i].len); > > + > > + if ((msgs[i].flags & I2C_M_RD) == 0) > > + for (j = 0 ; j < msgs[i].len ; j++) > > + dev_dbg(dev, > > + "buf[%d] = %x\n", j, msgs[i].buf[j]); > > + > > + num = it61620_ddc_xfer(it61620, &msgs[i]); > > + } > > + > > + return num; > > +} > > + > > +static u32 it61620_hdmi_i2c_func(struct i2c_adapter *adapter) > > +{ > > + return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL; > > +} > > + > > +static const struct i2c_algorithm hdmi_ddc_algorithm = { > > + .master_xfer = it61620_hdmi_i2c_xfer, > > + .functionality = it61620_hdmi_i2c_func, > > +}; > > + > > +static struct i2c_adapter *it61620_add_ddc_i2c_adapter(struct it61620 *it61620) > > +{ > > + struct i2c_adapter *adap = &it61620->ddc; > > + struct device *dev = it61620->dev; > > + int ret; > > + > > + adap->owner = THIS_MODULE; > > + adap->dev.parent = dev; > > + adap->algo = &hdmi_ddc_algorithm; > > + strscpy(adap->name, "ITE 61620 HDMI", sizeof(adap->name)); > > + i2c_set_adapdata(adap, it61620); > > + > > + ret = i2c_add_adapter(adap); > > + if (ret) { > > + dev_err(dev, > > + "cannot add %s I2C adapter\n", adap->name); > > + return ERR_PTR(ret); > > + } > > + > > + return 0; > > +} > > + > > +static int it61620_i2c_and_regmap_init(struct i2c_client *client, > > + struct it61620 *it61620) > > +{ > > + struct device *dev = it61620->dev; > > + > > + it61620->it61620_i2c = client; > > + > > + it61620->tx_i2c = devm_i2c_new_dummy_device(dev, > > + client->adapter, > > + TX_I2C_ADDRESS); > > + if (IS_ERR(it61620->tx_i2c)) > > + return dev_err_probe(dev, PTR_ERR(it61620->tx_i2c), > > + "failed to create TX dummy i2c device at 0x%02x\n", > > + TX_I2C_ADDRESS); > > + > > + it61620->mipirx_i2c = devm_i2c_new_dummy_device(dev, > > + client->adapter, > > + MIPIRX_I2C_ADDRESS); > > + if (IS_ERR(it61620->mipirx_i2c)) > > + return dev_err_probe(dev, PTR_ERR(it61620->mipirx_i2c), > > + "failed to create MIPI dummy i2c device at 0x%02x\n", > > + MIPIRX_I2C_ADDRESS); > > + > > + it61620->it61620_regmap = devm_regmap_init_i2c(it61620->it61620_i2c, > > + &it61620_regmap_config); > > + if (IS_ERR(it61620->it61620_regmap)) > > + return dev_err_probe(dev, PTR_ERR(it61620->it61620_regmap), > > + "failed to init I2C regmap for it61620\n"); > > + > > + it61620->tx_regmap = devm_regmap_init_i2c(it61620->tx_i2c, > > + &it61620_tx_regmap_config); > > + if (IS_ERR(it61620->tx_regmap)) > > + return dev_err_probe(dev, PTR_ERR(it61620->tx_regmap), > > + "failed to init I2C regmap for TX\n"); > > + > > + it61620->mipirx_regmap = devm_regmap_init_i2c(it61620->mipirx_i2c, > > + &it61620_mipi_regmap_config); > > + if (IS_ERR(it61620->mipirx_regmap)) > > + return dev_err_probe(dev, PTR_ERR(it61620->mipirx_regmap), > > + "failed to init I2C regmap for MIPI\n"); > > + return 0; > > +} > > + > > +static int it61620_of_get_dsi_host(struct it61620 *it61620, > > + struct mipi_dsi_host **host) > > +{ > > + struct device *dev = it61620->dev; > > + struct device_node *dsi_node; > > + struct device_node *host_node; > > + > > + dsi_node = of_graph_get_next_endpoint(dev->of_node, NULL); > > + > > + if (!dsi_node) > > + return dev_err_probe(dev, -ENODEV, "DSI NO endpoint at DT\n"); > > + > > + host_node = of_graph_get_remote_port_parent(dsi_node); > > + of_node_put(dsi_node); > > + > > + if (!host_node) > > + return dev_err_probe(dev, -ENODEV, "DSI NO host node at DT\n"); > > + > > + *host = of_find_mipi_dsi_host_by_node(host_node); > > + of_node_put(host_node); > > + > > + if (*host) > > + return 0; > > + > > + return dev_err_probe(dev, -EPROBE_DEFER, "failed to find dsi host\n"); > > +} > > + > > +static int it61620_attach_dsi(struct it61620 *it61620, > > + struct mipi_dsi_host *host) > > +{ > > + struct device *dev = it61620->dev; > > + struct mipi_dsi_device *dsi; > > + const struct mipi_dsi_device_info info = {"it61620", > > + 0, > > + dev->of_node}; > > + > > + dsi = devm_mipi_dsi_device_register_full(dev, host, &info); > > + if (IS_ERR(dsi)) > > + return dev_err_probe(dev, PTR_ERR(dsi), "failed to create dsi device\n"); > > + > > + it61620->dsi = dsi; > > + dsi->lanes = 4; > > + dsi->format = MIPI_DSI_FMT_RGB888; > > + dsi->mode_flags = MIPI_DSI_MODE_VIDEO | > > + MIPI_DSI_MODE_VIDEO_SYNC_PULSE; > > + > > + return devm_mipi_dsi_attach(dev, dsi); > > +} > > + > > +static void it61620_detach_dsi(struct it61620 *it61620) > > +{ > > + if (!it61620->dsi) > > + return; > > + > > + mipi_dsi_detach(it61620->dsi); > > +} > > + > > +static unsigned int it61620_parse_dt(struct it61620 *it61620) > > +{ > > + struct device *dev = it61620->dev; > > + struct device_node *np = it61620->dev->of_node; > > + u32 num_lanes = 0; > > + > > + if (!dev->of_node) > > + return -EINVAL; > > + > > + if (of_property_read_u32(np, "dsi-lanes", &num_lanes)) > > + dev_dbg(dev, > > + "cannot read dsi-lanes reg property\n"); > > + else > > + it61620->mipirx_config.lane_num = num_lanes; > > + > > + dev_dbg(dev, "num_lanes = %x\n", num_lanes); > > + > > + it61620->next_bridge = devm_drm_of_get_bridge(dev, np, 1, -1); > > + if (IS_ERR(it61620->next_bridge)) > > + return dev_err_probe(dev, -EPROBE_DEFER, > > + "failed to get next bridge\n"); > > + > > + return 0; > > +} > > + > > +static int it61620_init_pdata(struct it61620 *it61620) > > +{ > > + struct it61620_platform_data *pdata = &it61620->pdata; > > + struct device *dev = it61620->dev; > > + > > + pdata->gpiod_reset = devm_gpiod_get(dev, "reset", GPIOD_OUT_HIGH); > > + if (IS_ERR(pdata->gpiod_reset)) > > + return dev_err_probe(dev, PTR_ERR(pdata->gpiod_reset), > > + "gpiod_reset not found\n"); > > + > > + pdata->ivdd = devm_regulator_get(dev, "ivdd"); > > + if (IS_ERR(pdata->ivdd)) > > + return dev_err_probe(dev, PTR_ERR(pdata->ivdd), > > + "ivdd regulator not found\n"); > > + > > + pdata->ovdd1833 = devm_regulator_get(dev, "ovdd1833"); > > + if (IS_ERR(pdata->ovdd1833)) > > + return dev_err_probe(dev, PTR_ERR(pdata->ovdd1833), > > + "ovdd1833 regulator not found\n"); > > + > > + pdata->ovdd33 = devm_regulator_get(dev, "ovdd"); > > + if (IS_ERR(pdata->ovdd33)) > > + return dev_err_probe(dev, PTR_ERR(pdata->ovdd33), > > + "ovdd33 regulator not found\n"); > > + > > + return 0; > > +} > > + > > +static int __maybe_unused it61620_pm_bridge_suspend(struct device *dev) > > +{ > > + struct it61620 *it61620 = dev_get_drvdata(dev); > > + > > + it61620_poweroff(it61620); > > + > > + return 0; > > +} > > + > > +static int __maybe_unused it61620_pm_bridge_resume(struct device *dev) > > +{ > > + struct it61620 *it61620 = dev_get_drvdata(dev); > > + > > + return it61620_poweron(it61620); > > +} > > + > > +static const struct dev_pm_ops it61620_bridge_pm_ops = { > > + SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend, > > + pm_runtime_force_resume) > > + SET_RUNTIME_PM_OPS(it61620_pm_bridge_suspend, > > + it61620_pm_bridge_resume, NULL) > > +}; > > + > > +static int it61620_bridge_attach(struct drm_bridge *bridge, > > + struct drm_encoder *encoder, > > + enum drm_bridge_attach_flags flags) > > +{ > > + struct it61620 *it61620 = bridge_to_it61620(bridge); > > + struct drm_device *drm = bridge->dev; > > + int ret; > > + > > + it61620->drm = drm; > > + > > + if (!drm_core_check_feature(drm, DRIVER_ATOMIC)) { > > + drm_err(drm, > > + "it61620 driver only copes with atomic updates\n"); > > + return -EOPNOTSUPP; > > + } > > + > > + ret = drm_bridge_attach(bridge->encoder, it61620->next_bridge, > > + bridge, DRM_BRIDGE_ATTACH_NO_CONNECTOR); > > + if (ret < 0) > > + return ret; > > + > > + if (!(flags & DRM_BRIDGE_ATTACH_NO_CONNECTOR)) { > > + drm_dbg(drm, > > + "DRM_BRIDGE_ATTACH_NO_CONNECTOR must be supplied"); > > + return -EINVAL; > > + } > > + return 0; > > +} > > + > > +static void it61620_bridge_detach(struct drm_bridge *bridge) > > +{ > > +} > > + > > +static enum drm_mode_status it61620_bridge_mode_valid(struct drm_bridge *bridge, > > + const struct drm_display_info *info, > > + const struct drm_display_mode *mode) > > +{ > > + struct it61620 *it61620 = bridge_to_it61620(bridge); > > + > > + return it61620_mode_valid(it61620, mode); > > +} > > + > > +static void it61620_bridge_hpd_notify(struct drm_bridge *bridge, > > + enum drm_connector_status status) > > +{ > > + struct it61620 *it61620 = bridge_to_it61620(bridge); > > + struct drm_device *drm = it61620->drm; > > + struct device *dev = it61620->dev; > > + int hpd, ret; > > + > > + hpd = (status == connector_status_connected) ? 1 : 0; > > + > > + if (it61620->connector_status != status) { > > + drm_dbg(drm, "GPIO hpd status change %d->%d", > > + !hpd, hpd); > > + > > + it61620->connector_status = status; > > + if (hpd) { > > + drm_dbg(drm, "HPD_GPIO get to wake up"); > > + ret = pm_runtime_get_sync(dev); > > + if (ret < 0) > > + dev_err(dev, > > + "pm_runtime_get_sync error %d", ret); > > + } else { > > + drm_dbg(drm, "HPD_GPIO put to sleep"); > > + pm_runtime_mark_last_busy(dev); > > + pm_runtime_put_autosuspend(dev); > > + } > > + > > + } else { > > + drm_dbg(drm, "GPIO hpd status NO change %d", hpd); > > + } > > +} > > + > > +static void it61620_bridge_atomic_pre_enable(struct drm_bridge *bridge, > > + struct drm_atomic_state *state) > > +{ > > + struct it61620 *it61620 = bridge_to_it61620(bridge); > > + struct device *dev = it61620->dev; > > + > > + pm_runtime_get_sync(dev); > > +} > > + > > +static void it61620_bridge_atomic_enable(struct drm_bridge *bridge, > > + struct drm_atomic_state *state) > > +{ > > + struct it61620 *it61620 = bridge_to_it61620(bridge); > > + struct drm_crtc_state *crtc_state; > > + struct drm_connector_state *conn_state; > > + struct drm_display_mode *mode; > > + struct drm_connector *connector; > > + > > + connector = drm_atomic_get_new_connector_for_encoder(state, > > + bridge->encoder); > > + > > + if (!connector) > > + return; > > + it61620->connector = *connector; > > + > > + conn_state = drm_atomic_get_new_connector_state(state, connector); > > + if (WARN_ON(!conn_state)) > > + return; > > + > > + crtc_state = drm_atomic_get_new_crtc_state(state, conn_state->crtc); > > + if (WARN_ON(!crtc_state)) > > + return; > > + > > + mode = &crtc_state->adjusted_mode; > > + if (WARN_ON(!mode)) > > + return; > > + > > + drm_atomic_helper_connector_hdmi_update_infoframes(connector, state); > > + it61620_mipi_set_d2v_video_timing(it61620); > > + it61620_hdmi_config_output(it61620); > > +} > > + > > +static void it61620_bridge_atomic_disable(struct drm_bridge *bridge, > > + struct drm_atomic_state *state) > > +{ > > + struct it61620 *it61620 = bridge_to_it61620(bridge); > > + > > + if (it61620->powered) { > > + it61620_stop_hdcp_work(it61620); > > + it61620_hdmi_disable_afe(it61620); > > + it61620_hdmi_powerdown(it61620); > > + it61620->video_state = it61620_VIDEO_OFF; > > + } > > +} > > + > > +static void it61620_bridge_atomic_post_disable(struct drm_bridge *bridge, > > + struct drm_atomic_state *state) > > +{ > > + struct it61620 *it61620 = bridge_to_it61620(bridge); > > + struct device *dev = it61620->dev; > > + > > + pm_runtime_mark_last_busy(dev); > > + pm_runtime_put_autosuspend(dev); > > +} > > + > > +static const struct drm_edid *it61620_bridge_edid_read(struct drm_bridge *bridge, > > + struct drm_connector *connector) > > +{ > > + struct it61620 *it61620 = bridge_to_it61620(bridge); > > + struct device *dev = it61620->dev; > > + > > + if (!it61620->cached_edid) { > > + it61620->cached_edid = drm_edid_read_custom(connector, > > + it61620_get_edid_block, > > + it61620); > > + > > + if (!it61620->cached_edid) { > > + dev_err(dev, "failed to get edid!"); > > + return NULL; > > + } > > + it61620_set_capability_from_edid_parse(it61620, > > + drm_edid_raw(it61620->cached_edid)); > > + } > > + return drm_edid_dup(it61620->cached_edid); > > +} > > + > > +static void it61620_bridge_mode_set(struct drm_bridge *bridge, > > + const struct drm_display_mode *mode, > > + const struct drm_display_mode *adj) > > +{ > > + struct it61620 *it61620 = bridge_to_it61620(bridge); > > + > > + drm_display_mode_to_videomode(adj, &it61620->vm); > > +} > > + > > +static int it61620_bridge_hdmi_clear_infoframe(struct drm_bridge *bridge, > > + enum hdmi_infoframe_type type) > > +{ > > + struct it61620 *it61620 = bridge_to_it61620(bridge); > > + struct drm_device *drm = it61620->drm; > > + > > + switch (type) { > > + case HDMI_INFOFRAME_TYPE_AVI: > > + it61620_hdmi_disable_avi_infoframe(it61620); > > + break; > > + case HDMI_INFOFRAME_TYPE_AUDIO: > > + it61620_hdmi_disable_audio_infoframe(it61620); > > + break; > > + default: > > + drm_err(drm, "Error: hdmi infoframe_type %x!!!\n", type); > > + } > > + return 0; > > +} > > + > > +static int it61620_bridge_hdmi_write_infoframe(struct drm_bridge *bridge, > > + enum hdmi_infoframe_type type, > > + const u8 *buffer, size_t len) > > +{ > > + struct it61620 *it61620 = bridge_to_it61620(bridge); > > + struct drm_device *drm = it61620->drm; > > + > > + switch (type) { > > + case HDMI_INFOFRAME_TYPE_AVI: > > + it61620_hdmi_avi_infoframe_set(it61620, buffer, len); > > + break; > > + case HDMI_INFOFRAME_TYPE_AUDIO: > > + it61620_hdmi_audio_infoframe_set(it61620, buffer, len); > > + break; > > + default: > > + drm_err(drm, "Error: hdmi infoframe_type %x!!!\n", type); > > + } > > + return 0; > > +} > > + > > +static int it61620_bridge_hdmi_audio_startup(struct drm_connector *connector, > > + struct drm_bridge *bridge) > > +{ > > + struct it61620 *it61620 = bridge_to_it61620(bridge); > > + > > + it61620_enable_audio(it61620); > > + return 0; > > +} > > + > > +static int it61620_bridge_hdmi_audio_prepare(struct drm_connector *connector, > > + struct drm_bridge *bridge, > > + struct hdmi_codec_daifmt *fmt, > > + struct hdmi_codec_params *hparms) > > +{ > > + struct it61620 *it61620 = bridge_to_it61620(bridge); > > + > > + switch (hparms->sample_rate) { > > + case 32000: > > + case 44100: > > + case 48000: > > + case 88200: > > + case 96000: > > + case 176400: > > + case 192000: > > + case 768000: > > + break; > > + default: > > + return -EINVAL; > > + } > > + > > + switch (hparms->sample_width) { > > + case 16: > > + case 24: > > + case 18: > > + case 20: > > + break; > > + default: > > + return -EINVAL; > > + } > > + > > + switch (fmt->fmt) { > > + case HDMI_I2S: > > + case HDMI_SPDIF: > > + break; > > + default: > > + return -EINVAL; > > + } > > + > > + it61620_audio_update_hw_params(it61620, fmt, hparms); > > + > > + return drm_atomic_helper_connector_hdmi_update_audio_infoframe(connector, > > + &hparms->cea); > > +} > > + > > +static void it61620_bridge_hdmi_audio_shutdown(struct drm_connector *connector, > > + struct drm_bridge *bridge) > > +{ > > + struct it61620 *it61620 = bridge_to_it61620(bridge); > > + > > + it61620_disable_audio(it61620); > > +} > > + > > +static const struct drm_bridge_funcs it61620_bridge_funcs = { > > + .attach = it61620_bridge_attach, > > + .detach = it61620_bridge_detach, > > + .mode_valid = it61620_bridge_mode_valid, > > + .hpd_notify = it61620_bridge_hpd_notify, > > + > > + .atomic_pre_enable = it61620_bridge_atomic_pre_enable, > > + .atomic_enable = it61620_bridge_atomic_enable, > > + .atomic_disable = it61620_bridge_atomic_disable, > > + .atomic_post_disable = it61620_bridge_atomic_post_disable, > > + .atomic_duplicate_state = drm_atomic_helper_bridge_duplicate_state, > > + .atomic_destroy_state = drm_atomic_helper_bridge_destroy_state, > > + .atomic_reset = drm_atomic_helper_bridge_reset, > > + > > + .edid_read = it61620_bridge_edid_read, > > + .mode_set = it61620_bridge_mode_set, > > + > > + .hdmi_clear_infoframe = it61620_bridge_hdmi_clear_infoframe, > > + .hdmi_write_infoframe = it61620_bridge_hdmi_write_infoframe, > > + .hdmi_audio_startup = it61620_bridge_hdmi_audio_startup, > > + .hdmi_audio_prepare = it61620_bridge_hdmi_audio_prepare, > > + .hdmi_audio_shutdown = it61620_bridge_hdmi_audio_shutdown, > > +}; > > + > > +static int it61620_probe(struct i2c_client *client) > > +{ > > + struct device *dev = &client->dev; > > + struct device_node *np = dev->of_node; > > + struct mipi_dsi_host *host; > > + struct it61620 *it61620; > > + int ret = 0; > > + > > + it61620 = devm_drm_bridge_alloc(dev, struct it61620, bridge, > > + &it61620_bridge_funcs); > > + if (IS_ERR(it61620)) > > + return PTR_ERR(it61620); > > + > > + it61620->dev = dev; > > + it61620->chip_info = of_device_get_match_data(dev); > > + > > + ret = it61620_of_get_dsi_host(it61620, &host); > > + if (ret < 0) > > + return ret; > > + > > + ret = it61620_i2c_and_regmap_init(client, it61620); > > + if (ret < 0) > > + return ret; > > + > > + i2c_set_clientdata(client, it61620); > > + > > + ret = it61620_init_pdata(it61620); > > + if (ret < 0) > > + return ret; > > + > > + it61620_config_default(it61620); > > + it61620_parse_dt(it61620); > > + if (ret < 0) > > + return ret; > > + > > + if (!client->irq) > > + return dev_err_probe(dev, -ENODEV, > > + "Failed to get INTP IRQ\n"); > > + > > + ret = devm_request_threaded_irq(&client->dev, client->irq, NULL, > > + it61620_int_threaded_handler, > > + IRQF_TRIGGER_LOW | IRQF_ONESHOT | > > + IRQF_NO_AUTOEN, > > + "it61620-intp", it61620); > > + if (ret < 0) > > + return dev_err_probe(dev, ret, > > + "failed to request INTP threaded IRQ\n"); > > + > > + INIT_DELAYED_WORK(&it61620->hdcp_work, it61620_hdcp_work); > > + init_waitqueue_head(&it61620->wq); > > + > > + mutex_init(&it61620->ddc_lock); > > + > > + it61620_add_ddc_i2c_adapter(it61620); > > + > > + pm_runtime_enable(dev); > > + pm_runtime_set_autosuspend_delay(dev, 1000); > > + pm_runtime_use_autosuspend(dev); > > + > > + it61620->bridge.funcs = &it61620_bridge_funcs; > > + it61620->bridge.of_node = np; > > + it61620->bridge.ops = DRM_BRIDGE_OP_EDID | DRM_BRIDGE_OP_MODES | > > + DRM_BRIDGE_OP_HDMI | > > + DRM_BRIDGE_OP_HDMI_AUDIO; > > + it61620->bridge.type = DRM_MODE_CONNECTOR_HDMIA; > > + it61620->bridge.hdmi_audio_max_i2s_playback_channels = 8; > > + it61620->bridge.hdmi_audio_spdif_playback = false; > > + it61620->bridge.vendor = "ITE"; > > + it61620->bridge.product = "IT61620"; > > + > > + ret = devm_drm_bridge_add(dev, &it61620->bridge); > > + if (ret < 0) > > + return dev_err_probe(dev, ret, > > + "failed to add drm bridge\n"); > > + > > + ret = it61620_attach_dsi(it61620, host); > > + if (ret < 0) > > + return dev_err_probe(dev, ret, > > + "failed to attach to DSI host\n"); > > + > > + return 0; > > +} > > + > > +static void it61620_remove(struct i2c_client *client) > > +{ > > + struct it61620 *it61620 = i2c_get_clientdata(client); > > + struct device *dev = it61620->dev; > > + > > + disable_irq(client->irq); > > + pm_runtime_disable(dev); > > + it61620_remove_edid(it61620); > > + it61620_detach_dsi(it61620); > > + > > + mutex_destroy(&it61620->ddc_lock); > > +} > > + > > +static const struct it6162_chip_info it61620_chip_info = { > > + .vid = 0x4954, > > + .pid = 0x6152, > > +}; > > + > > +static const struct of_device_id it61620_dt_ids[] = { > > + { .compatible = "ite,it61620", .data = &it61620_chip_info}, > > + { } > > +}; > > +MODULE_DEVICE_TABLE(of, it61620_dt_ids); > > + > > +static const struct i2c_device_id it61620_i2c_ids[] = { > > + { "it61620", 0 }, > > + { }, > > +}; > > +MODULE_DEVICE_TABLE(i2c, it61620_i2c_ids); > > + > > +static struct i2c_driver it61620_driver = { > > + .driver = { > > + .name = "it61620", > > + .of_match_table = it61620_dt_ids, > > + .pm = &it61620_bridge_pm_ops, > > + }, > > + .probe = it61620_probe, > > + .remove = it61620_remove, > > + .id_table = it61620_i2c_ids, > > +}; > > + > > +module_i2c_driver(it61620_driver); > > + > > +MODULE_AUTHOR("Pet Weng <pet.weng@ite.com.tw>"); > > +MODULE_AUTHOR("Hermes Wu <Hermes.Wu@ite.com.tw>"); > > +MODULE_DESCRIPTION("it61620 mipi to hdmi driver"); > > +MODULE_LICENSE("GPL"); > > > > -- > > 2.34.1 > > > > Regards, > Pin-yen Regards, Pet Weng ^ permalink raw reply [flat|nested] 7+ messages in thread
* [PATCH 3/3] MAINTAINERS: Add entry for ITE IT61620 MIPI to HDMI bridge driver 2025-07-14 3:14 [PATCH 0/3] Add ITE IT61620 MIPI DSI to HDMI bridge driver Pet Weng 2025-07-14 3:14 ` [PATCH 1/3] dt-binding: display: Add a device tree binding for the ITE IT61620 MIPI DSI to HDMI bridge Pet Weng 2025-07-14 3:14 ` [PATCH 2/3] drm/bridge: Add ITE IT61620 MIPI DSI to HDMI bridge driver Pet Weng @ 2025-07-14 3:14 ` Pet Weng 2 siblings, 0 replies; 7+ messages in thread From: Pet Weng @ 2025-07-14 3:14 UTC (permalink / raw) To: Andrzej Hajda, Neil Armstrong, Robert Foss, Laurent Pinchart, Jonas Karlman, Jernej Skrabec, Maarten Lankhorst, Maxime Ripard, Thomas Zimmermann, David Airlie, Simona Vetter, Rob Herring, Krzysztof Kozlowski, Conor Dooley Cc: dri-devel, devicetree, linux-kernel, Hermes Wu, Kenneth Hung, Pet Weng, Pin-yen Lin Add a new entry for the ITE IT61620 MIPI to HDMI bridge driver to the MAINTAINERS file, include the responsible maintainer, mailing list, and file patterns. Signed-off-by: Pet Weng <pet.weng@ite.com.tw> --- MAINTAINERS | 8 ++++++++ 1 file changed, 8 insertions(+) diff --git a/MAINTAINERS b/MAINTAINERS index ee2ef9d9db2ab3a2b462aaa1a7a473018c70596d..3a7167ac8a840321d2c5b0f230e3e29f72ced0b8 100644 --- a/MAINTAINERS +++ b/MAINTAINERS @@ -12916,6 +12916,14 @@ T: git https://gitlab.freedesktop.org/drm/misc/kernel.git F: Documentation/devicetree/bindings/display/bridge/ite,it6263.yaml F: drivers/gpu/drm/bridge/ite-it6263.c +ITE IT61620 MIPI DSI TO HDMI BRIDGE DRIVER +M: Pet Weng <pet.weng@ite.com.tw> +L: dri-devel@lists.freedesktop.org +S: Maintained +T: git https://gitlab.freedesktop.org/drm/misc/kernel.git +F: Documentation/devicetree/bindings/display/bridge/ite,it61620.yaml +F: drivers/gpu/drm/bridge/ite-it61620.c + ITE IT66121 HDMI BRIDGE DRIVER M: Phong LE <ple@baylibre.com> M: Neil Armstrong <neil.armstrong@linaro.org> -- 2.34.1 ^ permalink raw reply related [flat|nested] 7+ messages in thread
end of thread, other threads:[~2025-08-20 3:30 UTC | newest] Thread overview: 7+ messages (download: mbox.gz follow: Atom feed -- links below jump to the message on this page -- 2025-07-14 3:14 [PATCH 0/3] Add ITE IT61620 MIPI DSI to HDMI bridge driver Pet Weng 2025-07-14 3:14 ` [PATCH 1/3] dt-binding: display: Add a device tree binding for the ITE IT61620 MIPI DSI to HDMI bridge Pet Weng 2025-07-15 3:37 ` Rob Herring 2025-07-14 3:14 ` [PATCH 2/3] drm/bridge: Add ITE IT61620 MIPI DSI to HDMI bridge driver Pet Weng 2025-08-18 9:16 ` Pin-yen Lin 2025-08-20 3:29 ` Pet.Weng 2025-07-14 3:14 ` [PATCH 3/3] MAINTAINERS: Add entry for ITE IT61620 MIPI " Pet Weng
This is a public inbox, see mirroring instructions for how to clone and mirror all data and code used for this inbox; as well as URLs for NNTP newsgroup(s).