From patchwork Fri Sep 18 14:24:20 2020 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Maxime Chevallier X-Patchwork-Id: 11785187 Return-Path: Received: from mail.kernel.org (pdx-korg-mail-1.web.codeaurora.org [172.30.200.123]) by pdx-korg-patchwork-2.web.codeaurora.org (Postfix) with ESMTP id 624F159D for ; Fri, 18 Sep 2020 14:26:57 +0000 (UTC) Received: from merlin.infradead.org (merlin.infradead.org [205.233.59.134]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by mail.kernel.org (Postfix) with ESMTPS id 3123A20848 for ; Fri, 18 Sep 2020 14:26:57 +0000 (UTC) Authentication-Results: mail.kernel.org; dkim=pass (2048-bit key) header.d=lists.infradead.org header.i=@lists.infradead.org header.b="P4TE5Tvi" DMARC-Filter: OpenDMARC Filter v1.3.2 mail.kernel.org 3123A20848 Authentication-Results: mail.kernel.org; dmarc=none (p=none dis=none) header.from=bootlin.com Authentication-Results: mail.kernel.org; spf=none smtp.mailfrom=linux-arm-kernel-bounces+patchwork-linux-arm=patchwork.kernel.org@lists.infradead.org DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=merlin.20170209; h=Sender:Content-Transfer-Encoding: Content-Type:Cc:List-Subscribe:List-Help:List-Post:List-Archive: List-Unsubscribe:List-Id:MIME-Version:References:In-Reply-To:Message-Id:Date: Subject:To:From:Reply-To:Content-ID:Content-Description:Resent-Date: Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID:List-Owner; bh=gSak5VT+u92CVp11wE9FexXyBVZaDP4apG/l5VVkD3g=; b=P4TE5Tvi1XBVYokip78g9hOvV sl9Fs7HFcb2/1gmdz+3l8jd/d+18T5mxdcTArzAMHtWOEtItA/D99vXJy6h7esYF9GgfTGxH/5s00 AJ53v80ghlLr9ERouyLUaXAciHAGS4f5LfPOvY1UTJc1OtIHLGXWyzgcbVtSJdImIFCtTPYgiCy4c RxJpa48GV6cjsC7M6FUXS8V6icObcNOEgrR9u7tKExwQ7wfR4nMid2ykMKn3vA0Z06tMtOOoCJQjX vYFQPr5FipGpgSzxUIUafL1ZrPzvA1Y/GYg9iJ0y4ADjlMClbIq6YIH/+ARVqbvfo5VQ5QLRwTaDh 3VU+xOy+A==; Received: from localhost ([::1] helo=merlin.infradead.org) by merlin.infradead.org with esmtp (Exim 4.92.3 #3 (Red Hat Linux)) id 1kJHKK-0001ak-Am; Fri, 18 Sep 2020 14:25:28 +0000 Received: from relay10.mail.gandi.net ([217.70.178.230]) by merlin.infradead.org with esmtps (Exim 4.92.3 #3 (Red Hat Linux)) id 1kJHKC-0001XZ-GV for linux-arm-kernel@lists.infradead.org; Fri, 18 Sep 2020 14:25:21 +0000 Received: from pc-2.home (lfbn-tou-1-1532-46.w90-89.abo.wanadoo.fr [90.89.95.46]) (Authenticated sender: maxime.chevallier@bootlin.com) by relay10.mail.gandi.net (Postfix) with ESMTPSA id BE24E24000C; Fri, 18 Sep 2020 14:25:15 +0000 (UTC) From: Maxime Chevallier To: Mauro Carvalho Chehab , Rob Herring , Mark Rutland , Heiko Stuebner , Hans Verkuil , Laurent Pinchart Subject: [PATCH 1/3] dt-bindings: vendor-prefixes: Add techwell vendor prefix Date: Fri, 18 Sep 2020 16:24:20 +0200 Message-Id: <20200918142422.1086555-2-maxime.chevallier@bootlin.com> X-Mailer: git-send-email 2.25.4 In-Reply-To: <20200918142422.1086555-1-maxime.chevallier@bootlin.com> References: <20200918142422.1086555-1-maxime.chevallier@bootlin.com> MIME-Version: 1.0 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20200918_102520_652348_51D16706 X-CRM114-Status: GOOD ( 11.24 ) X-Spam-Score: -0.7 (/) X-Spam-Report: SpamAssassin version 3.4.4 on merlin.infradead.org summary: Content analysis details: (-0.7 points) pts rule name description ---- ---------------------- -------------------------------------------------- -0.0 RCVD_IN_MSPIKE_H2 RBL: Average reputation (+2) [217.70.178.230 listed in wl.mailspike.net] -0.7 RCVD_IN_DNSWL_LOW RBL: Sender listed at https://www.dnswl.org/, low trust [217.70.178.230 listed in list.dnswl.org] -0.0 SPF_PASS SPF: sender matches SPF record 0.0 SPF_HELO_NONE SPF: HELO does not publish an SPF Record X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.29 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Cc: devicetree@vger.kernel.org, linux-kernel@vger.kernel.org, Maxime Chevallier , Paul Kocialkowski , Thomas Petazzoni , Miquel Raynal , linux-arm-kernel@lists.infradead.org, linux-media@vger.kernel.org Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+patchwork-linux-arm=patchwork.kernel.org@lists.infradead.org Add prefix for Techwell, Inc. Signed-off-by: Maxime Chevallier Acked-by: Rob Herring --- Documentation/devicetree/bindings/vendor-prefixes.yaml | 2 ++ 1 file changed, 2 insertions(+) diff --git a/Documentation/devicetree/bindings/vendor-prefixes.yaml b/Documentation/devicetree/bindings/vendor-prefixes.yaml index 63996ab03521..3fcf071c4467 100644 --- a/Documentation/devicetree/bindings/vendor-prefixes.yaml +++ b/Documentation/devicetree/bindings/vendor-prefixes.yaml @@ -1033,6 +1033,8 @@ patternProperties: description: TechNexion "^technologic,.*": description: Technologic Systems + "^techwell,.*": + description: Techwell, Inc. "^tempo,.*": description: Tempo Semiconductor "^techstar,.*": From patchwork Fri Sep 18 14:24:21 2020 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Maxime Chevallier X-Patchwork-Id: 11785183 Return-Path: Received: from mail.kernel.org (pdx-korg-mail-1.web.codeaurora.org [172.30.200.123]) by pdx-korg-patchwork-2.web.codeaurora.org (Postfix) with ESMTP id 331A659D for ; Fri, 18 Sep 2020 14:25:45 +0000 (UTC) Received: from merlin.infradead.org (merlin.infradead.org [205.233.59.134]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by mail.kernel.org (Postfix) with ESMTPS id 050BB20684 for ; Fri, 18 Sep 2020 14:25:45 +0000 (UTC) Authentication-Results: mail.kernel.org; dkim=pass (2048-bit key) header.d=lists.infradead.org header.i=@lists.infradead.org header.b="2h3o1PzD" DMARC-Filter: OpenDMARC Filter v1.3.2 mail.kernel.org 050BB20684 Authentication-Results: mail.kernel.org; dmarc=none (p=none dis=none) header.from=bootlin.com Authentication-Results: mail.kernel.org; spf=none smtp.mailfrom=linux-arm-kernel-bounces+patchwork-linux-arm=patchwork.kernel.org@lists.infradead.org DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=merlin.20170209; h=Sender:Content-Transfer-Encoding: Content-Type:Cc:List-Subscribe:List-Help:List-Post:List-Archive: List-Unsubscribe:List-Id:MIME-Version:References:In-Reply-To:Message-Id:Date: Subject:To:From:Reply-To:Content-ID:Content-Description:Resent-Date: Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID:List-Owner; bh=OFXifBzat/Z70/+ZKn0fXCF82WJocMc+WKDxzHZGntc=; b=2h3o1PzDsflj6MYd4ytH9v/DQ CPW8Vf4ee40V2s5crdmjhGopsw8yveINL+ali1X55FEpl7HqD+B40CiN9HX3kanm+XOhG1ZzNMnJB 4PW5z/Z+7OP/IHZ4pTZjNFJfVuNu6OGRt+GLrBFYfZB5FagYR39YrtOvgdyPK2htJYY+uGLiKZ1sP e7F/8LC4ToFbjrAHOAi7jUx5euN3xwbW14PHCUzb3e2qwKj+glXdzpuxSqwDibNjivFE+uK3QXt+D 5qqRgKqn7ZyyG6XziOfHyl7J/+IA5kBv7QJF3OIxcrnxYuGCEiN1PSo6boux8FHXAjAeuQWwjMugR ctzns0/fg==; Received: from localhost ([::1] helo=merlin.infradead.org) by merlin.infradead.org with esmtp (Exim 4.92.3 #3 (Red Hat Linux)) id 1kJHKO-0001bg-Gj; Fri, 18 Sep 2020 14:25:32 +0000 Received: from relay10.mail.gandi.net ([217.70.178.230]) by merlin.infradead.org with esmtps (Exim 4.92.3 #3 (Red Hat Linux)) id 1kJHKG-0001Yy-3i for linux-arm-kernel@lists.infradead.org; Fri, 18 Sep 2020 14:25:25 +0000 Received: from pc-2.home (lfbn-tou-1-1532-46.w90-89.abo.wanadoo.fr [90.89.95.46]) (Authenticated sender: maxime.chevallier@bootlin.com) by relay10.mail.gandi.net (Postfix) with ESMTPSA id C88D9240012; Fri, 18 Sep 2020 14:25:19 +0000 (UTC) From: Maxime Chevallier To: Mauro Carvalho Chehab , Rob Herring , Mark Rutland , Heiko Stuebner , Hans Verkuil , Laurent Pinchart Subject: [PATCH 2/3] media: dt-bindings: media: i2c: Add bindings for TW9900 Date: Fri, 18 Sep 2020 16:24:21 +0200 Message-Id: <20200918142422.1086555-3-maxime.chevallier@bootlin.com> X-Mailer: git-send-email 2.25.4 In-Reply-To: <20200918142422.1086555-1-maxime.chevallier@bootlin.com> References: <20200918142422.1086555-1-maxime.chevallier@bootlin.com> MIME-Version: 1.0 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20200918_102524_272197_EBEAD5DF X-CRM114-Status: GOOD ( 14.31 ) X-Spam-Score: -0.7 (/) X-Spam-Report: SpamAssassin version 3.4.4 on merlin.infradead.org summary: Content analysis details: (-0.7 points) pts rule name description ---- ---------------------- -------------------------------------------------- -0.0 RCVD_IN_MSPIKE_H2 RBL: Average reputation (+2) [217.70.178.230 listed in wl.mailspike.net] -0.7 RCVD_IN_DNSWL_LOW RBL: Sender listed at https://www.dnswl.org/, low trust [217.70.178.230 listed in list.dnswl.org] -0.0 SPF_PASS SPF: sender matches SPF record 0.0 SPF_HELO_NONE SPF: HELO does not publish an SPF Record X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.29 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Cc: devicetree@vger.kernel.org, linux-kernel@vger.kernel.org, Maxime Chevallier , Paul Kocialkowski , Thomas Petazzoni , Miquel Raynal , linux-arm-kernel@lists.infradead.org, linux-media@vger.kernel.org Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+patchwork-linux-arm=patchwork.kernel.org@lists.infradead.org The Techwell TW9900 is a video decoder supporting multiple input standards, such as PAL, NTSC and SECAM, and outputs a BT.656 video signal. It's designed to be low-power, posesses some features such as a programmable comb-filter, and automatic input standard detection. Signed-off-by: Maxime Chevallier --- .../devicetree/bindings/media/i2c/tw9900.yaml | 59 +++++++++++++++++++ 1 file changed, 59 insertions(+) create mode 100644 Documentation/devicetree/bindings/media/i2c/tw9900.yaml diff --git a/Documentation/devicetree/bindings/media/i2c/tw9900.yaml b/Documentation/devicetree/bindings/media/i2c/tw9900.yaml new file mode 100644 index 000000000000..fdc2c35875aa --- /dev/null +++ b/Documentation/devicetree/bindings/media/i2c/tw9900.yaml @@ -0,0 +1,59 @@ +# SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause) +%YAML 1.2 +--- +$id: http://devicetree.org/schemas/media/i2c/tw9900.yaml# +$schema: http://devicetree.org/meta-schemas/core.yaml# + +title: Techwell TW9900 NTSC/PAL/SECAM video decoder + +maintainers: + - Maxime Chevallier + +description: + The tw9900 is a multi-standard video decoder, supporting NTSC, PAL and SECAM + standards with auto-detection features. + +properties: + compatible: + items: + - enum: + - techwell,tw9900 + + reg: + maxItems: 1 + + vdd-supply: + description: VDD power supply + + port: + type: object + description: + A node containing a single endpoint as doucmented in + Documentation/devicetree/bindings/media/video-interfaces.txt + +additionalProperties: false + +required: + - compatible + - reg + +examples: + - | + i2c { + #address-cells = <1>; + #size-cells = <0>; + + tw9900: tw9900@44 { + compatible = "techwell,tw9900"; + reg = <0x44>; + + vdd-supply = <&tw9900_supply>; + reset-gpio = <&gpio2 RK_PB5 GPIO_ACTIVE_LOW>; + + port { + tw9900_out: endpoint { + remote-endpoint = <&vip_in>; + }; + }; + }; + }; From patchwork Fri Sep 18 14:24:22 2020 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Maxime Chevallier X-Patchwork-Id: 11785191 Return-Path: Received: from mail.kernel.org (pdx-korg-mail-1.web.codeaurora.org [172.30.200.123]) by pdx-korg-patchwork-2.web.codeaurora.org (Postfix) with ESMTP id 754EF59D for ; Fri, 18 Sep 2020 14:27:22 +0000 (UTC) Received: from merlin.infradead.org (merlin.infradead.org [205.233.59.134]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by mail.kernel.org (Postfix) with ESMTPS id 3E120208C3 for ; Fri, 18 Sep 2020 14:27:22 +0000 (UTC) Authentication-Results: mail.kernel.org; dkim=pass (2048-bit key) header.d=lists.infradead.org header.i=@lists.infradead.org header.b="FmjfsJc8" DMARC-Filter: OpenDMARC Filter v1.3.2 mail.kernel.org 3E120208C3 Authentication-Results: mail.kernel.org; dmarc=none (p=none dis=none) header.from=bootlin.com Authentication-Results: mail.kernel.org; spf=none smtp.mailfrom=linux-arm-kernel-bounces+patchwork-linux-arm=patchwork.kernel.org@lists.infradead.org DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=merlin.20170209; h=Sender:Content-Transfer-Encoding: Content-Type:Cc:List-Subscribe:List-Help:List-Post:List-Archive: List-Unsubscribe:List-Id:MIME-Version:References:In-Reply-To:Message-Id:Date: Subject:To:From:Reply-To:Content-ID:Content-Description:Resent-Date: Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID:List-Owner; bh=5/VFQkPS9EVy9FLch6GibZYypUIIyF4v2ttPh/7mKAc=; b=FmjfsJc8kkmB/mS6c3Zoc9aLa uZg7Kh53ZivcTqNmqcyv0g633XXebwa40uBMYFIcE2yMnb9Nr2ac+/MfU41KX9Xnb0wlcbRER5qwQ yzfI1mDERm32dX4o4Jh9DySPqPq4061PHvV3L5iKCzDKjsqtyDTcmLe83oYv+IuB6AVgc6dkSVK4x ab/qSrdaZKxJAbho6A4RjWc+RAT2PiiLnawiqtkf18GZ6eqx/tvtEQBvouNhPiBnvOkq2uha3vUS7 Zisngpfl4y265WjWOD/2uVK43MFYw7nAWObDuBXzUT3j0weUm4PtN1YK/hxCvCswCph0wt7U6IANh JTEh/zHvA==; Received: from localhost ([::1] helo=merlin.infradead.org) by merlin.infradead.org with esmtp (Exim 4.92.3 #3 (Red Hat Linux)) id 1kJHKV-0001e7-Av; Fri, 18 Sep 2020 14:25:39 +0000 Received: from relay10.mail.gandi.net ([217.70.178.230]) by merlin.infradead.org with esmtps (Exim 4.92.3 #3 (Red Hat Linux)) id 1kJHKK-0001ab-6g for linux-arm-kernel@lists.infradead.org; Fri, 18 Sep 2020 14:25:30 +0000 Received: from pc-2.home (lfbn-tou-1-1532-46.w90-89.abo.wanadoo.fr [90.89.95.46]) (Authenticated sender: maxime.chevallier@bootlin.com) by relay10.mail.gandi.net (Postfix) with ESMTPSA id 53901240014; Fri, 18 Sep 2020 14:25:23 +0000 (UTC) From: Maxime Chevallier To: Mauro Carvalho Chehab , Rob Herring , Mark Rutland , Heiko Stuebner , Hans Verkuil , Laurent Pinchart Subject: [PATCH 3/3] media: i2c: Introduce a driver for the Techwell TW9900 decoder Date: Fri, 18 Sep 2020 16:24:22 +0200 Message-Id: <20200918142422.1086555-4-maxime.chevallier@bootlin.com> X-Mailer: git-send-email 2.25.4 In-Reply-To: <20200918142422.1086555-1-maxime.chevallier@bootlin.com> References: <20200918142422.1086555-1-maxime.chevallier@bootlin.com> MIME-Version: 1.0 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20200918_102528_424948_391AA744 X-CRM114-Status: GOOD ( 29.28 ) X-Spam-Score: -0.7 (/) X-Spam-Report: SpamAssassin version 3.4.4 on merlin.infradead.org summary: Content analysis details: (-0.7 points) pts rule name description ---- ---------------------- -------------------------------------------------- -0.0 RCVD_IN_MSPIKE_H2 RBL: Average reputation (+2) [217.70.178.230 listed in wl.mailspike.net] -0.7 RCVD_IN_DNSWL_LOW RBL: Sender listed at https://www.dnswl.org/, low trust [217.70.178.230 listed in list.dnswl.org] -0.0 SPF_PASS SPF: sender matches SPF record 0.0 SPF_HELO_NONE SPF: HELO does not publish an SPF Record X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.29 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Cc: devicetree@vger.kernel.org, linux-kernel@vger.kernel.org, Maxime Chevallier , Paul Kocialkowski , Thomas Petazzoni , Miquel Raynal , linux-arm-kernel@lists.infradead.org, linux-media@vger.kernel.org Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+patchwork-linux-arm=patchwork.kernel.org@lists.infradead.org The Techwell video decoder supports PAL, NTSC and SECAM input formats, and outputs a BT.656 signal. This commit adds support for this device, based on an implementation made by Rockchip. This implemention adds basic support for NTSC and PAL, and some basic brightness and contrast controls. Signed-off-by: Maxime Chevallier --- drivers/media/i2c/Kconfig | 9 + drivers/media/i2c/Makefile | 1 + drivers/media/i2c/tw9900.c | 671 +++++++++++++++++++++++++++++++++++++ 3 files changed, 681 insertions(+) create mode 100644 drivers/media/i2c/tw9900.c diff --git a/drivers/media/i2c/Kconfig b/drivers/media/i2c/Kconfig index c7ba76fee599..9b9f97fa4335 100644 --- a/drivers/media/i2c/Kconfig +++ b/drivers/media/i2c/Kconfig @@ -426,6 +426,15 @@ config VIDEO_TW2804 To compile this driver as a module, choose M here: the module will be called tw2804. +config VIDEO_TW9900 + tristate "Techwell TW9900 video decoder" + depends on VIDEO_V4L2 && I2C + help + Support for the Techwell tw9900 multi-standard video decoder + + To compile this driver as a module, choose M here: the + module will be called tw9900. + config VIDEO_TW9903 tristate "Techwell TW9903 video decoder" depends on VIDEO_V4L2 && I2C diff --git a/drivers/media/i2c/Makefile b/drivers/media/i2c/Makefile index f0a77473979d..cbc1d9aedd38 100644 --- a/drivers/media/i2c/Makefile +++ b/drivers/media/i2c/Makefile @@ -49,6 +49,7 @@ obj-$(CONFIG_VIDEO_TVP5150) += tvp5150.o obj-$(CONFIG_VIDEO_TVP514X) += tvp514x.o obj-$(CONFIG_VIDEO_TVP7002) += tvp7002.o obj-$(CONFIG_VIDEO_TW2804) += tw2804.o +obj-$(CONFIG_VIDEO_TW9900) += tw9900.o obj-$(CONFIG_VIDEO_TW9903) += tw9903.o obj-$(CONFIG_VIDEO_TW9906) += tw9906.o obj-$(CONFIG_VIDEO_TW9910) += tw9910.o diff --git a/drivers/media/i2c/tw9900.c b/drivers/media/i2c/tw9900.c new file mode 100644 index 000000000000..950a7bbda80d --- /dev/null +++ b/drivers/media/i2c/tw9900.c @@ -0,0 +1,671 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Driver for the Techwell TW9900 multi-standard video decoder. + * + * Copyright (C) 2018 Fuzhou Rockchip Electronics Co., Ltd. + * Copyright (C) 2020 Maxime Chevallier + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define TW9900_REG_CHIP_ID 0x00 +#define TW9900_REG_CHIP_STATUS 0x01 +#define TW9900_REG_CHIP_STATUS_VLOCK 0x08 +#define TW9900_REG_CHIP_STATUS_VDLOSS 0x80 +#define TW9900_REG_OUT_FMT_CTL 0x03 +#define TW9900_REG_CKHY_HSDLY 0x04 +#define TW9900_REG_OUT_CTRL_I 0x05 +#define TW9900_REG_ANALOG_CTL 0x06 +#define TW9900_REG_CROP_HI 0x07 +#define TW9900_REG_VDELAY_LO 0x08 +#define TW9900_REG_VACTIVE_LO 0x09 +#define TW9900_REG_HACTIVE_LO 0x0B +#define TW9900_REG_CNTRL1 0x0C +#define TW9900_REG_BRIGHT_CTL 0x10 +#define TW9900_REG_CONTRAST_CTL 0x11 +#define TW9900_REG_VBI_CNTL 0x19 +#define TW9900_REG_ANAL_CTL_II 0x1A +#define TW9900_REG_OUT_CTRL_II 0x1B +#define TW9900_REG_STD_SEL 0x1C +#define TW9900_REG_MISSCNT 0x26 +#define TW9900_REG_MISC_CTL_II 0x2F +#define TW9900_REG_VVBI 0x55 + +#define TW9900_CHIP_ID 0x00 + +#define REG_SC_CTRL_MODE TW9900_REG_OUT_FMT_CTL +#define SC_CTRL_MODE_STANDBY 0xA7 +#define SC_CTRL_MODE_STREAMING 0xA0 + +#define REG_NULL 0xFF + +#define VSYNC_POLL_INTERVAL_MS 20 +#define VSYNC_WAIT_MAX_POLLS 50 + +static const char * const tw9900_supply_names[] = { + "vdd", +}; + +#define TW9900_NUM_SUPPLIES ARRAY_SIZE(tw9900_supply_names) + +struct regval { + u8 addr; + u8 val; +}; + +struct tw9900_mode { + u32 width; + u32 height; + u32 skip_top; + u32 std; + u32 field; + const struct regval *reg_list; +}; + +struct tw9900 { + struct i2c_client *client; + struct gpio_desc *reset_gpio; + struct regulator_bulk_data supplies[TW9900_NUM_SUPPLIES]; + + bool streaming; + + struct v4l2_subdev subdev; + struct v4l2_ctrl_handler hdl; + struct media_pad pad; + + struct timer_list timer; + struct work_struct work_i2c_poll; + + const struct tw9900_mode *cur_mode; +}; + +#define to_tw9900(sd) container_of(sd, struct tw9900, subdev) + +static const struct regval tw9900_init_regs[] = { + {TW9900_REG_MISC_CTL_II, 0xE6}, + {TW9900_REG_MISSCNT, 0x24}, + {TW9900_REG_OUT_FMT_CTL, 0xA7}, + {TW9900_REG_ANAL_CTL_II, 0x0A}, + {TW9900_REG_VDELAY_LO, 0x19}, + {TW9900_REG_STD_SEL, 0x00}, + {TW9900_REG_VACTIVE_LO, 0xF0}, + {TW9900_REG_STD_SEL, 0x07}, + {TW9900_REG_CKHY_HSDLY, 0x40}, + {TW9900_REG_ANALOG_CTL, 0x80}, + {TW9900_REG_CNTRL1, 0xdc}, + {TW9900_REG_OUT_CTRL_I, 0x98}, + {REG_NULL, 0x0}, +}; + +static const struct regval tw9900_yuv_regs[] = { + {REG_NULL, 0x0}, +}; + +static const struct regval tw9900_pal_regs[] = { + {TW9900_REG_STD_SEL, 0x01}, + {REG_NULL, 0x0}, +}; + +static const struct regval tw9900_ntsc_regs[] = { + {TW9900_REG_OUT_FMT_CTL, 0xA4}, + {TW9900_REG_VDELAY_LO, 0x12}, + {TW9900_REG_VACTIVE_LO, 0xf0}, + {TW9900_REG_CROP_HI, 0x02}, + {TW9900_REG_HACTIVE_LO, 0xD0}, + {TW9900_REG_VBI_CNTL, 0x01}, + {TW9900_REG_STD_SEL, 0x00}, + {REG_NULL, 0x0}, +}; + +static const struct tw9900_mode supported_modes[] = { + { + .width = 720, + .height = 576, + .skip_top = 0, + .std = V4L2_STD_PAL, + .field = V4L2_FIELD_NONE, + .reg_list = tw9900_pal_regs, + }, + { + .width = 720, + .height = 480, + .skip_top = 0, + .std = V4L2_STD_NTSC, + .field = V4L2_FIELD_NONE, + .reg_list = tw9900_ntsc_regs, + }, +}; + +static int tw9900_write_reg(struct i2c_client *client, u8 reg, u8 val) +{ + int ret; + + ret = i2c_smbus_write_byte_data(client, reg, val); + + if (ret < 0) + dev_err(&client->dev, "write reg error: %d\n", ret); + + return ret; +} + +static int tw9900_write_array(struct i2c_client *client, + const struct regval *regs) +{ + int i, ret = 0; + + for (i = 0; ret == 0 && regs[i].addr != REG_NULL; i++) + ret = tw9900_write_reg(client, regs[i].addr, regs[i].val); + + return ret; +} + +static inline u8 tw9900_read_reg(struct i2c_client *client, u8 reg) +{ + return i2c_smbus_read_byte_data(client, reg); +} + +static void tw9900_fill_fmt(const struct tw9900_mode *mode, + struct v4l2_mbus_framefmt *fmt) +{ + fmt->code = MEDIA_BUS_FMT_UYVY8_2X8; + fmt->width = mode->width; + fmt->height = mode->height; + fmt->field = mode->field; + fmt->colorspace = V4L2_COLORSPACE_SMPTE170M; +} + +static int tw9900_find_closest_mode_index(u32 width, u32 height) +{ + int i, best_score = 0, score, best = 0; + + for (i = 0; i < ARRAY_SIZE(supported_modes); i++) { + score = abs(supported_modes[i].width - width) + + abs(supported_modes[i].height - height); + + if (best_score > score) { + best_score = score; + best = i; + } + } + + return best; +} + +static int tw9900_find_mode_index(u32 width, u32 height) +{ + int i; + + for (i = 0; i < ARRAY_SIZE(supported_modes); i++) + if (supported_modes[i].width == width && + supported_modes[i].height == height) + return i; + + /* No match, find the closestmatch */ + return tw9900_find_closest_mode_index(width, height); +} + +static int tw9900_set_fmt(struct v4l2_subdev *sd, + struct v4l2_subdev_pad_config *cfg, + struct v4l2_subdev_format *fmt) +{ + struct tw9900 *tw9900 = to_tw9900(sd); + struct v4l2_mbus_framefmt *mbus_fmt = &fmt->format; + int mode_index = tw9900_find_mode_index(mbus_fmt->width, + mbus_fmt->height); + + if (mode_index < 0) + return -EINVAL; + + tw9900->cur_mode = &supported_modes[mode_index]; + + tw9900_fill_fmt(tw9900->cur_mode, mbus_fmt); + + /* Update the dimensions in case we don't have a perfect match */ + mbus_fmt->width = tw9900->cur_mode->width; + mbus_fmt->height = tw9900->cur_mode->height; + + return 0; +} + +static int tw9900_get_fmt(struct v4l2_subdev *sd, + struct v4l2_subdev_pad_config *cfg, + struct v4l2_subdev_format *fmt) +{ + struct tw9900 *tw9900 = to_tw9900(sd); + struct v4l2_mbus_framefmt *mbus_fmt = &fmt->format; + + tw9900_fill_fmt(tw9900->cur_mode, mbus_fmt); + + return 0; +} + +static int tw9900_enum_mbus_code(struct v4l2_subdev *sd, + struct v4l2_subdev_pad_config *cfg, + struct v4l2_subdev_mbus_code_enum *code) +{ + if (code->index >= ARRAY_SIZE(supported_modes)) + return -EINVAL; + + code->code = MEDIA_BUS_FMT_UYVY8_2X8; + + return 0; +} + +static int tw9900_enum_frame_sizes(struct v4l2_subdev *sd, + struct v4l2_subdev_pad_config *cfg, + struct v4l2_subdev_frame_size_enum *fse) +{ + u32 index = fse->index; + + if (index >= ARRAY_SIZE(supported_modes)) + return -EINVAL; + + fse->code = MEDIA_BUS_FMT_UYVY8_2X8; + + fse->min_width = supported_modes[index].width; + fse->max_width = supported_modes[index].width; + fse->max_height = supported_modes[index].height; + fse->min_height = supported_modes[index].height; + + return 0; +} + +static int tw9900_g_skip_top_lines(struct v4l2_subdev *sd, u32 *lines) +{ + struct tw9900 *tw9900 = to_tw9900(sd); + + *lines = tw9900->cur_mode->skip_top; + + return 0; +} + +static int __tw9900_power_on(struct tw9900 *tw9900) +{ + int ret; + struct device *dev = &tw9900->client->dev; + + if (tw9900->reset_gpio) + gpiod_set_value_cansleep(tw9900->reset_gpio, 1); + + ret = regulator_bulk_enable(TW9900_NUM_SUPPLIES, tw9900->supplies); + if (ret < 0) + goto error; + + usleep_range(50000, 52000); + + if (tw9900->reset_gpio) + gpiod_set_value_cansleep(tw9900->reset_gpio, 0); + + usleep_range(1000, 2000); + + ret = tw9900_write_array(tw9900->client, tw9900_init_regs); + if (ret) { + dev_err(dev, "Failed to init tw9900\n"); + goto error; + } + + return 0; + +error: + + return ret; +} + +static void __tw9900_power_off(struct tw9900 *tw9900) +{ + if (tw9900->reset_gpio) + gpiod_set_value_cansleep(tw9900->reset_gpio, 1); + + regulator_bulk_disable(TW9900_NUM_SUPPLIES, tw9900->supplies); +} + +static int tw9900_s_ctrl(struct v4l2_ctrl *ctrl) +{ + struct tw9900 *tw9900 = container_of(ctrl->handler, struct tw9900, hdl); + + if (pm_runtime_suspended(&tw9900->client->dev)) + return 0; + + switch (ctrl->id) { + case V4L2_CID_BRIGHTNESS: + tw9900_write_reg(tw9900->client, 0x10, (u8)ctrl->val); + break; + case V4L2_CID_CONTRAST: + tw9900_write_reg(tw9900->client, 0x11, (u8)ctrl->val); + break; + default: + return -EINVAL; + } + return 0; +} + +static int tw9900_s_stream(struct v4l2_subdev *sd, int on) +{ + struct tw9900 *tw9900 = to_tw9900(sd); + struct i2c_client *client = tw9900->client; + int i, ret = 0; + + on = !!on; + if (on == tw9900->streaming) + goto unlock_and_return; + + if (on) { + ret = pm_runtime_get_sync(&tw9900->client->dev); + if (ret < 0) { + pm_runtime_put_noidle(&client->dev); + goto unlock_and_return; + } + + ret = v4l2_ctrl_handler_setup(sd->ctrl_handler); + if (ret) { + pm_runtime_put(&client->dev); + goto unlock_and_return; + } + + ret = tw9900_write_array(tw9900->client, + tw9900->cur_mode->reg_list); + if (ret) { + pm_runtime_put(&client->dev); + goto unlock_and_return; + } + + /* Wait for VSync lock */ + for (i = 0; i < VSYNC_WAIT_MAX_POLLS; i++) { + u8 status = tw9900_read_reg(tw9900->client, + TW9900_REG_CHIP_STATUS); + if (!(status & TW9900_REG_CHIP_STATUS_VDLOSS) && + (status & TW9900_REG_CHIP_STATUS_VLOCK)) + break; + + msleep(VSYNC_POLL_INTERVAL_MS); + } + + ret = tw9900_write_reg(client, REG_SC_CTRL_MODE, + SC_CTRL_MODE_STREAMING); + if (ret) { + pm_runtime_put(&client->dev); + goto unlock_and_return; + } + + } else { + tw9900_write_reg(client, REG_SC_CTRL_MODE, + SC_CTRL_MODE_STANDBY); + pm_runtime_put(&client->dev); + } + + tw9900->streaming = on; + +unlock_and_return: + + return ret; +} + +#ifdef CONFIG_VIDEO_V4L2_SUBDEV_API +static int tw9900_open(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh) +{ + struct tw9900 *tw9900 = to_tw9900(sd); + struct v4l2_mbus_framefmt *try_fmt; + + try_fmt = v4l2_subdev_get_try_format(sd, fh->pad, 0); + + /* Initialize try_fmt */ + tw9900_fill_fmt(tw9900->cur_mode, try_fmt); + + return 0; +} +#endif + +static int tw9900_runtime_resume(struct device *dev) +{ + struct i2c_client *client = to_i2c_client(dev); + struct v4l2_subdev *sd = i2c_get_clientdata(client); + struct tw9900 *tw9900 = to_tw9900(sd); + + return __tw9900_power_on(tw9900); +} + +static int tw9900_runtime_suspend(struct device *dev) +{ + struct i2c_client *client = to_i2c_client(dev); + struct v4l2_subdev *sd = i2c_get_clientdata(client); + struct tw9900 *tw9900 = to_tw9900(sd); + + __tw9900_power_off(tw9900); + + return 0; +} + +static int tw9900_subscribe_event(struct v4l2_subdev *sd, + struct v4l2_fh *fh, + struct v4l2_event_subscription *sub) +{ + switch (sub->type) { + case V4L2_EVENT_SOURCE_CHANGE: + return v4l2_src_change_event_subdev_subscribe(sd, fh, sub); + case V4L2_EVENT_CTRL: + return v4l2_ctrl_subdev_subscribe_event(sd, fh, sub); + default: + return -EINVAL; + } +} + +static const struct dev_pm_ops tw9900_pm_ops = { + SET_RUNTIME_PM_OPS(tw9900_runtime_suspend, + tw9900_runtime_resume, NULL) +}; + +static const struct v4l2_subdev_core_ops tw9900_core_ops = { + .subscribe_event = tw9900_subscribe_event, + .unsubscribe_event = v4l2_event_subdev_unsubscribe, +}; + +static const struct v4l2_subdev_video_ops tw9900_video_ops = { + .s_stream = tw9900_s_stream, +}; + +static const struct v4l2_subdev_pad_ops tw9900_pad_ops = { + .enum_mbus_code = tw9900_enum_mbus_code, + .enum_frame_size = tw9900_enum_frame_sizes, + .get_fmt = tw9900_get_fmt, + .set_fmt = tw9900_set_fmt, +}; + +static struct v4l2_subdev_sensor_ops tw9900_sensor_ops = { + .g_skip_top_lines = tw9900_g_skip_top_lines, +}; + +static const struct v4l2_subdev_ops tw9900_subdev_ops = { + .core = &tw9900_core_ops, + .video = &tw9900_video_ops, + .pad = &tw9900_pad_ops, + .sensor = &tw9900_sensor_ops, +}; + +static const struct v4l2_ctrl_ops tw9900_ctrl_ops = { + .s_ctrl = tw9900_s_ctrl, +}; + +#ifdef CONFIG_VIDEO_V4L2_SUBDEV_API +static const struct v4l2_subdev_internal_ops tw9900_internal_ops = { + .open = tw9900_open, +}; +#endif + +static int tw9900_check_sensor_id(struct tw9900 *tw9900, + struct i2c_client *client) +{ + struct device *dev = &tw9900->client->dev; + u8 id; + + id = tw9900_read_reg(client, TW9900_CHIP_ID); + + if (id != TW9900_CHIP_ID) { + dev_err(dev, "Wrong camera sensor id(%04x)\n", id); + return -EINVAL; + } + + dev_info(dev, "Detected TW9900 (%04x) sensor\n", TW9900_CHIP_ID); + + return 0; +} + +static int tw9900_configure_regulators(struct tw9900 *tw9900) +{ + u32 i; + + for (i = 0; i < TW9900_NUM_SUPPLIES; i++) + tw9900->supplies[i].supply = tw9900_supply_names[i]; + + return devm_regulator_bulk_get(&tw9900->client->dev, + TW9900_NUM_SUPPLIES, + tw9900->supplies); +} + +static int tw9900_probe(struct i2c_client *client, + const struct i2c_device_id *id) +{ + struct device *dev = &client->dev; + struct v4l2_ctrl_handler *hdl; + struct tw9900 *tw9900; + int ret; + + tw9900 = devm_kzalloc(dev, sizeof(*tw9900), GFP_KERNEL); + if (!tw9900) + return -ENOMEM; + + tw9900->client = client; + tw9900->cur_mode = &supported_modes[0]; + + tw9900->reset_gpio = devm_gpiod_get(dev, "reset", GPIOD_OUT_LOW); + if (IS_ERR(tw9900->reset_gpio)) + tw9900->reset_gpio = NULL; + + ret = tw9900_configure_regulators(tw9900); + if (ret) { + dev_err(dev, "Failed to get power regulators\n"); + return ret; + } + + v4l2_i2c_subdev_init(&tw9900->subdev, client, &tw9900_subdev_ops); + tw9900->subdev.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE | V4L2_SUBDEV_FL_HAS_EVENTS; + + hdl = &tw9900->hdl; + + v4l2_ctrl_handler_init(hdl, 2); + + v4l2_ctrl_new_std(hdl, &tw9900_ctrl_ops, V4L2_CID_BRIGHTNESS, + -128, 127, 1, 0); + v4l2_ctrl_new_std(hdl, &tw9900_ctrl_ops, V4L2_CID_CONTRAST, + 0, 255, 1, 0x60); + + tw9900->subdev.ctrl_handler = hdl; + if (hdl->error) { + int err = hdl->error; + + v4l2_ctrl_handler_free(hdl); + return err; + } + + ret = __tw9900_power_on(tw9900); + if (ret) + return ret; + + ret = tw9900_check_sensor_id(tw9900, client); + if (ret) + goto err_power_off; + +#ifdef CONFIG_VIDEO_V4L2_SUBDEV_API + tw9900->subdev.internal_ops = &tw9900_internal_ops; + tw9900->subdev.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE; +#endif +#if defined(CONFIG_MEDIA_CONTROLLER) + tw9900->pad.flags = MEDIA_PAD_FL_SOURCE; + tw9900->subdev.entity.function = MEDIA_ENT_F_CAM_SENSOR; + + ret = media_entity_pads_init(&tw9900->subdev.entity, 1, &tw9900->pad); + if (ret < 0) + goto err_power_off; +#endif + + ret = v4l2_async_register_subdev(&tw9900->subdev); + if (ret) { + dev_err(dev, "v4l2 async register subdev failed\n"); + goto err_clean_entity; + } + + pm_runtime_set_active(dev); + pm_runtime_enable(dev); + pm_runtime_idle(dev); + + return 0; + +err_clean_entity: +#if defined(CONFIG_MEDIA_CONTROLLER) + media_entity_cleanup(&tw9900->subdev.entity); +#endif +err_power_off: + __tw9900_power_off(tw9900); + + return ret; +} + +static int tw9900_remove(struct i2c_client *client) +{ + struct v4l2_subdev *sd = i2c_get_clientdata(client); + struct tw9900 *tw9900 = to_tw9900(sd); + + v4l2_async_unregister_subdev(sd); +#if defined(CONFIG_MEDIA_CONTROLLER) + media_entity_cleanup(&sd->entity); +#endif + + pm_runtime_disable(&client->dev); + if (!pm_runtime_status_suspended(&client->dev)) + __tw9900_power_off(tw9900); + pm_runtime_set_suspended(&client->dev); + + return 0; +} + +static const struct i2c_device_id tw9900_id[] = { + {"tw9900", 0}, + {}, +}; + +#if IS_ENABLED(CONFIG_OF) +static const struct of_device_id tw9900_of_match[] = { + { .compatible = "techwell,tw9900" }, + {}, +}; +MODULE_DEVICE_TABLE(of, tw9900_of_match); +#endif + +static struct i2c_driver tw9900_i2c_driver = { + .driver = { + .name = "tw9900", + .pm = &tw9900_pm_ops, + .of_match_table = tw9900_of_match + }, + .probe = tw9900_probe, + .remove = tw9900_remove, + .id_table = tw9900_id, +}; + +module_i2c_driver(tw9900_i2c_driver); + +MODULE_DESCRIPTION("tw9900 sensor driver"); +MODULE_LICENSE("GPL v2");