From patchwork Tue Feb 16 01:52:45 2016
Content-Type: text/plain; charset="utf-8"
MIME-Version: 1.0
Content-Transfer-Encoding: 7bit
X-Patchwork-Submitter: Meng Yi <meng.yi@nxp.com>
X-Patchwork-Id: 8322831
Return-Path: <dri-devel-bounces@lists.freedesktop.org>
X-Original-To: patchwork-dri-devel@patchwork.kernel.org
Delivered-To: patchwork-parsemail@patchwork1.web.kernel.org
Received: from mail.kernel.org (mail.kernel.org [198.145.29.136])
	by patchwork1.web.kernel.org (Postfix) with ESMTP id C666B9F372
	for <patchwork-dri-devel@patchwork.kernel.org>;
	Tue, 16 Feb 2016 08:44:58 +0000 (UTC)
Received: from mail.kernel.org (localhost [127.0.0.1])
	by mail.kernel.org (Postfix) with ESMTP id 4594620340
	for <patchwork-dri-devel@patchwork.kernel.org>;
	Tue, 16 Feb 2016 08:44:57 +0000 (UTC)
Received: from gabe.freedesktop.org (gabe.freedesktop.org [131.252.210.177])
	by mail.kernel.org (Postfix) with ESMTP id 275C0202F8
	for <patchwork-dri-devel@patchwork.kernel.org>;
	Tue, 16 Feb 2016 08:44:55 +0000 (UTC)
Received: from gabe.freedesktop.org (localhost [127.0.0.1])
	by gabe.freedesktop.org (Postfix) with ESMTP id 9A4696E760;
	Tue, 16 Feb 2016 08:44:53 +0000 (UTC)
X-Original-To: dri-devel@lists.freedesktop.org
Delivered-To: dri-devel@lists.freedesktop.org
Received: from na01-by2-obe.outbound.protection.outlook.com
	(mail-by2on0072.outbound.protection.outlook.com [207.46.100.72])
	by gabe.freedesktop.org (Postfix) with ESMTPS id C7D1E6E212
	for <dri-devel@lists.freedesktop.org>;
	Tue, 16 Feb 2016 02:01:44 +0000 (UTC)
Received: from CH1PR03CA009.namprd03.prod.outlook.com (10.255.156.154) by
	BLUPR03MB1490.namprd03.prod.outlook.com (10.163.81.20) with Microsoft
	SMTP Server (TLS) id 15.1.396.15; Tue, 16 Feb 2016 02:01:42 +0000
Received: from BY2FFO11FD022.protection.gbl (10.255.156.132) by
	CH1PR03CA009.outlook.office365.com (10.255.156.154) with Microsoft
	SMTP Server (TLS) id 15.1.409.15 via Frontend Transport;
	Tue, 16 Feb 2016 02:01:42 +0000
Authentication-Results: spf=fail (sender IP is 192.88.158.2)
	smtp.mailfrom=nxp.com; gmail.com; dkim=none (message not signed)
	header.d=none; gmail.com; dmarc=none action=none header.from=nxp.com;
Received-SPF: Fail (protection.outlook.com: domain of nxp.com does not
	designate 192.88.158.2 as permitted sender)
	receiver=protection.outlook.com;
	client-ip=192.88.158.2; helo=az84smr01.freescale.net;
Received: from az84smr01.freescale.net (192.88.158.2) by
	BY2FFO11FD022.mail.protection.outlook.com (10.1.15.211) with
	Microsoft SMTP Server (TLS) id 15.1.415.6 via Frontend Transport;
	Tue, 16 Feb 2016 02:01:41 +0000
Received: from titan.ap.freescale.net ([10.192.208.233])
	by az84smr01.freescale.net (8.14.3/8.14.0) with ESMTP id
	u1G21aE5016008; Mon, 15 Feb 2016 19:01:37 -0700
From: Meng Yi <meng.yi@nxp.com>
To: <stefan@agner.ch>
Subject: [PATCH v2 1/3] drm/layerscape: Add sii9022a driver
Date: Tue, 16 Feb 2016 09:52:45 +0800
Message-ID: <1455587567-14606-1-git-send-email-meng.yi@nxp.com>
X-Mailer: git-send-email 2.1.0.27.g96db324
X-EOPAttributedMessage: 0
X-Matching-Connectors: 131000617019818675;
	(91ab9b29-cfa4-454e-5278-08d120cd25b8); ()
X-Microsoft-Exchange-Diagnostics: 1; BY2FFO11FD022;
	1:1gsAWs3vcwT2e52lAygpniBzX57kxW0LBDdBqpM4BsMzGu+8n4/jzxl7sl5b5RWg/ayHHsy3eYOn/N00HESmdGvrUAagIZ4i9SY+jt+KGz5xrCuaXTdrVsV2yqTpIhlb5CEvzUGCC2ACTnTF2d7nvGReTiTJAJCEPmC3oCTYE5+jUHS16u2xT7s0ankl0HVDU5vO1JwfRBDBHtnnulL4o1swX8L0DDw54lVkaNRvoAPw07J8lnMiCBJ9up35FTTIFfASG1txvxJlvk3JL7zvPSUz6ss1lIdQYbV868QRUEO7X1Wwh3R0Jhh+HoNh1JRNKTUA016WhGsqDAXBv/Yx2OpgprAuo70TDGPyKYLa/gbZy+ADlE1rmDOPvbeVdKJzQu2OC6cH6pEJaMnMZ3/cXaeuzYYB3CJ0KgqOC1EKt51L8iELSu99iHEHA+1maq8ZIaHefU9pBwgrb3TOXNeMeBKgVoYaqihxd6rEFgNX9kk=
X-Forefront-Antispam-Report: CIP:192.88.158.2; CTRY:US; IPV:NLI; EFV:NLI;
	SFV:NSPM;
	SFS:(10009020)(6009001)(2980300002)(1110001)(1109001)(339900001)(199003)(189002)(5001960100002)(1096002)(110136002)(19580395003)(1220700001)(5003940100001)(50226001)(575784001)(86362001)(33646002)(85426001)(50986999)(19580405001)(77096005)(6806005)(104016004)(36756003)(11100500001)(47776003)(5008740100001)(105606002)(87936001)(48376002)(2351001)(50466002)(189998001)(92566002)(229853001)(106466001)(586003)(4326007)(2906002)(7059030);
	DIR:OUT; SFP:1101; SCL:1; SRVR:BLUPR03MB1490;
	H:az84smr01.freescale.net; FPR:;
	SPF:Fail; MLV:sfv; A:1; MX:1; LANG:en;
MIME-Version: 1.0
X-MS-Office365-Filtering-Correlation-Id: c57d7275-d25f-4f97-c2b3-08d336751d49
X-Microsoft-Exchange-Diagnostics: 1; BLUPR03MB1490;
	2:Dl+YEEO7fc78N5TgVRqPclynnyxu8Jm7o24IIbmZSrkExzyz0cJFYOLBxUO4wbi6R/XCFdZw+p0e/sZuZG4xje0P1KMVHgxaYS1U01d+Hn7DQqsl4pXlDLkYeESqCegDc8o+Aj10Obg/q4EDut8fpdhM1HR9sR0pIOA79G2LSo0u9RFcAIZYoq2jsFBCK55Y;
	3:Yw8pCMQujcUkK+XH8jn8xEVR9QBVLLu/7PDqbzFSxcmYD1C5EU8Xkq+IlRord2JBBxF2KU9GuQWlAeKDicsQgVEYXGsozWjPgMRVLSvdfj4S2Qmce/xbP0z+UorwDhp0AaWc5oLqtbX7OJ8SETzSq7lZmtt069HOq3eUSAuETxtKemBwcE963nuKqzVR++fmLJ6o0bUSGAuNPvsdp8U0MBMQgNR8Mh3Bq5gK+BAI/6I=;
	25:eTHN4UHMrKQ4GFzR0YlhWkaz/csaUcaX33JSZncfuADXRJ+FrCeu5KP61wGwVMrdWtW2aksLYRhVjJQmfcErbvHP+M10d73iYXiGgMht2eZL/3SJYfWC+i/zuJzaatuU4e4XDGFEdzQc40brb/Xy6mdEKR2MuvDMKM6oR1KFTWdLVDLso0UNd0IeGwpxcl6jx42Y7XY1UE5zkaAbzR5YNZw9Ica3MJBsZNXHA1EZuxcDujpXImTzqpRw9F2Z+TlnVQteHaMu8r1plqsxINWON3dYZUpnAPwat2wQx5Uf1x/4LsU95unIUygAI+bw440f
X-Microsoft-Antispam: UriScan:;BCL:0;PCL:0;RULEID:;SRVR:BLUPR03MB1490;
X-Microsoft-Antispam-PRVS: 
 <BLUPR03MB1490923310BDA5C93473783CECAD0@BLUPR03MB1490.namprd03.prod.outlook.com>
X-Exchange-Antispam-Report-Test: UriScan:(185117386973197);
X-Exchange-Antispam-Report-CFA-Test: BCL:0; PCL:0;
	RULEID:(601004)(2401047)(5005006)(13018025)(13017025)(13015025)(13023025)(13024025)(8121501046)(3002001)(10201501046);
	SRVR:BLUPR03MB1490; BCL:0; PCL:0; RULEID:(400006); SRVR:BLUPR03MB1490;
X-Microsoft-Exchange-Diagnostics: 1; BLUPR03MB1490;
	4:xAnNVUVpxgvuubrjyjel7ekglEgs8R+vIBqSWLIk4dD2HCZ6F4iiHlQ7g4cHm1pmY7CdV8M5GYzmwUV+yOEsDorzgLUKn9xBX5LWbiEAK/Y8nA/uf9J5vqkBVQAQSYGqnmy7GulDl1BPqPqG5S89D9DXnddJd5bD7h8USYifU1Tmz6MJ1LMuDzB1BzwzjJ4+FFnuVPwIPf4Q1ieFNjSEVQeLMF7fM35y8ua2BrEi44OI/TqAPU8PeqkdlbzJrv3CEIY5fvB32XnJFqgeQbcR+AzG1z8PExmdR6kmKyJTReDf0y1BPOKF2Tvybk/sopH2GZX13bxPQ9GjjsHWp8HZjLAkP46MPrhTQoDIDHdTn6pLFf+49wbaJPhH3EPfIw+MBPTCw39y5aITb9FdUCu6Y/CXhd0Vqhs0LpDPLxbDMbzoA9ErZIi3yDp3A4N2pvyoPvpJqo4g5LL0d09xuuzouLhGz15Y6HIOLogzMyaLNEmkiUqIcpIp3o52BIknzyEX
X-Forefront-PRVS: 0854128AF0
X-Microsoft-Exchange-Diagnostics: =?us-ascii?Q?1; BLUPR03MB1490;
	23:5K8yK7uuC2gYvCR6iMquIK4EQyaFp8fmrXeQB5QTc?=
	=?us-ascii?Q?4hedmFYBFpz+mvGyJjW5FAC7yRANj80johzWQ+/SIamY2SuLNndmVI5aetF6?=
	=?us-ascii?Q?UcrsesXwms6JD2yhDFpPzI5unAM+JYbLF8IDQ9cX6oiHg6d+0Wct3ZKHpjcY?=
	=?us-ascii?Q?i+WhSyGDIC2cqOHnwWKYLZtyyYR/6ojwEGO6aGGTKAXppYJMVfE/UjYfTb/p?=
	=?us-ascii?Q?BGcC170tXgeGkueYwScJFFo3HOO/i9sIpwT1Tsy/afHA7loiGVexJg3P288P?=
	=?us-ascii?Q?4WTx7fffpaz0AP3pAXusrgX6UmlDopKLPzV3Oi5xulwes8T45faM3+7Eubm3?=
	=?us-ascii?Q?yVGC3/JUFNvKExtSgyFrDVR/zi8C4YPlI7E+/TQbqx7o43b/80/ipBj/LVg+?=
	=?us-ascii?Q?fhMcAgq8UGV95W0EGJ47IPTRb2x7Tl+g6D3hKD3TKm4EyUbUgku6IyZWx2In?=
	=?us-ascii?Q?xyzvitI2JGJnT2eK45achv6T9XwbxI+CU+kw8v3VpWkDkshLbQ8y3iaySKli?=
	=?us-ascii?Q?OOZFn71vi7VVJ8+h3XK5MOu2Z1D1/HvBRQWPz6nGoFb6LlRamiPLT0bHdc7v?=
	=?us-ascii?Q?rE3cLojiWiYXD2xOjVRDJxiyFCUvPFD0XUols5e3RzMN/W0xkiN1mwfjOMY0?=
	=?us-ascii?Q?28/BuHXL9BaxP/kfaEnxXMJK2rSkGzK68TUY6vGKvgXTFtN7bcSVwc5H6tYI?=
	=?us-ascii?Q?uKjOaRueesKHtbay7X7vnicDX6ur0oiKtbEvUjlx/fw1tVLwwHckay947SD3?=
	=?us-ascii?Q?gt7I+iaOE2Zf4H6rKYm8/APeONG5e3F/StH9K6mtdcZeJgiKt99q4xCJ7CIf?=
	=?us-ascii?Q?akJwrOQMil/5yJJ+h4S/dzdA6XWceANRgNwavPOrc17xw9kPZmWIt8/jqPWt?=
	=?us-ascii?Q?YtOcD8NPV79m7m8nsIjQICqakGXDqxWEDphDv7kL05L466JN7jO4XDpPrYxy?=
	=?us-ascii?Q?ZbhwUVQVD75JO1nKVfaSitsZVhNeIaMK5zvCm696BIJydYfI3a4Da/ssPYof?=
	=?us-ascii?Q?T/vzD5dUavDycvGbukGHpo7m0cXfSH3Vm1w1J/ysI3LNDKNWOGN/p31nzcA7?=
	=?us-ascii?Q?DkeBrc=3D?=
X-Microsoft-Exchange-Diagnostics: 1; BLUPR03MB1490;
	5:Zio/lkixVh9F5eObXa9T/lnpi4PqbQIIHveA9xVSzdJrJ4ay/nXP59eWuk5XiGDi9K6Pb1AkkfFT8/PndM7ynTj6w2ryKTKsxWKGUyNYYtBMSqSxeQXwQx/AjkFn/1xGqIxvLD/mWoB196gPK66mQVWEESL1Xb15ovpVmxfD7oA=;
	24:pKIZ+0+1c6JAY1olaPdLW7c44TDMbgLSSwkVHyCxVxhJ/5avnXrykdPnKHGQV0cvDxbSFrWSrSpwfQG48Ge3dyk4nRHVPgAxiO5aVLoPe4c=
SpamDiagnosticOutput: 1:23
SpamDiagnosticMetadata: NSPM
X-MS-Exchange-CrossTenant-OriginalArrivalTime: 16 Feb 2016 02:01:41.5294
	(UTC)
X-MS-Exchange-CrossTenant-Id: 5afe0b00-7697-4969-b663-5eab37d5f47e
X-MS-Exchange-CrossTenant-OriginalAttributedTenantConnectingIp: 
 TenantId=5afe0b00-7697-4969-b663-5eab37d5f47e;
	Ip=[192.88.158.2];
	Helo=[az84smr01.freescale.net]
X-MS-Exchange-CrossTenant-FromEntityHeader: HybridOnPrem
X-MS-Exchange-Transport-CrossTenantHeadersStamped: BLUPR03MB1490
X-Mailman-Approved-At: Tue, 16 Feb 2016 08:44:50 +0000
Cc: Meng Yi <meng.yi@nxp.com>, Xiubo Li <lixiubo@cmss.chinamobile.com>,
	Alison Wang <alison.wang@nxp.com>, dri-devel@lists.freedesktop.org
X-BeenThere: dri-devel@lists.freedesktop.org
X-Mailman-Version: 2.1.18
Precedence: list
List-Id: Direct Rendering Infrastructure - Development
	<dri-devel.lists.freedesktop.org>
List-Unsubscribe: <https://lists.freedesktop.org/mailman/options/dri-devel>,
	<mailto:dri-devel-request@lists.freedesktop.org?subject=unsubscribe>
List-Archive: <https://lists.freedesktop.org/archives/dri-devel>
List-Post: <mailto:dri-devel@lists.freedesktop.org>
List-Help: <mailto:dri-devel-request@lists.freedesktop.org?subject=help>
List-Subscribe: <https://lists.freedesktop.org/mailman/listinfo/dri-devel>,
	<mailto:dri-devel-request@lists.freedesktop.org?subject=subscribe>
Errors-To: dri-devel-bounces@lists.freedesktop.org
Sender: "dri-devel" <dri-devel-bounces@lists.freedesktop.org>
X-Spam-Status: No, score=-4.2 required=5.0 tests=BAD_ENC_HEADER,BAYES_00,
	RCVD_IN_DNSWL_MED, RP_MATCHES_RCVD,
	UNPARSEABLE_RELAY autolearn=unavailable version=3.3.1
X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on mail.kernel.org
X-Virus-Scanned: ClamAV using ClamSMTP

The SiI9022A is an ultra low-power HDMI transmitter. It supports
resolutions from standard definition 480i/p and 576i/p all the way
to high-definition 720p, 1080i, and 1080p, the highest resolution
supported by HDTVs today. It also supports all PC resolutions up
to UXGA for netbooks

Signed-off-by: Meng Yi <meng.yi@nxp.com>
Signed-off-by: Alison Wang <alison.wang@nxp.com>
Signed-off-by: Xiubo Li <lixiubo@cmss.chinamobile.com>
Signed-off-by: Jianwei Wang <jianwei.wang.chn@gmail.com>
---
 drivers/gpu/drm/i2c/Kconfig       |   6 +
 drivers/gpu/drm/i2c/Makefile      |   3 +
 drivers/gpu/drm/i2c/sii9022_drv.c | 449 ++++++++++++++++++++++++++++++++++++++
 3 files changed, 458 insertions(+)
 create mode 100644 drivers/gpu/drm/i2c/sii9022_drv.c

diff --git a/drivers/gpu/drm/i2c/Kconfig b/drivers/gpu/drm/i2c/Kconfig
index 22c7ed6..8646729 100644
--- a/drivers/gpu/drm/i2c/Kconfig
+++ b/drivers/gpu/drm/i2c/Kconfig
@@ -31,4 +31,10 @@ config DRM_I2C_NXP_TDA998X
 	help
 	  Support for NXP Semiconductors TDA998X HDMI encoders.
 
+config DRM_I2C_SII9022
+	tristate "Silicon Image sii9022 TMDS transmitter"
+	help
+	  Support for sii9022 and similar single-link (or dual-link
+	  when used in pairs) TMDS transmitters.
+
 endmenu
diff --git a/drivers/gpu/drm/i2c/Makefile b/drivers/gpu/drm/i2c/Makefile
index 2c72eb5..cf2e8b9 100644
--- a/drivers/gpu/drm/i2c/Makefile
+++ b/drivers/gpu/drm/i2c/Makefile
@@ -10,3 +10,6 @@ obj-$(CONFIG_DRM_I2C_SIL164) += sil164.o
 
 tda998x-y := tda998x_drv.o
 obj-$(CONFIG_DRM_I2C_NXP_TDA998X) += tda998x.o
+
+sii9022-y := sii9022_drv.o
+obj-$(CONFIG_DRM_I2C_SII9022) +=sii9022.o
diff --git a/drivers/gpu/drm/i2c/sii9022_drv.c b/drivers/gpu/drm/i2c/sii9022_drv.c
new file mode 100644
index 0000000..bc49cad
--- /dev/null
+++ b/drivers/gpu/drm/i2c/sii9022_drv.c
@@ -0,0 +1,449 @@
+/*
+ * Copyright 2015 Freescale Semiconductor, Inc.
+ *
+ * Freescale DCU drm device driver
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ */
+
+#include <linux/console.h>
+#include <linux/delay.h>
+#include <linux/errno.h>
+#include <linux/fb.h>
+#include <linux/fsl_devices.h>
+#include <linux/i2c.h>
+#include <linux/init.h>
+#include <linux/interrupt.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/of_device.h>
+#include <linux/backlight.h>
+#include <video/videomode.h>
+#include <video/of_display_timing.h>
+
+#include <drm/drmP.h>
+#include <drm/drm_atomic_helper.h>
+#include <drm/drm_encoder_slave.h>
+#include <drm/drm_crtc_helper.h>
+#include <drm/drm_edid.h>
+
+
+#define SII902X_INPUT_BUS_FMT	0x08
+#define SII902X_TPI_AVI_INPUT_FMT	0x09
+#define SII902X_TPI_AVI_OUTPUT_FMT	0x0A
+#define SII902X_SYS_CONTROL	0x1A
+#define SII902X_SYS_CTR_DDC_REQ	BIT(2)
+#define SII902X_SYS_CTR_DDC_BUS_AVAI	(BIT(2) | BIT(1))
+#define SII902X_TPI_FAMILY_DEV_ID	0x1B
+#define SII902X_TPI_DEV_REV_ID	0x1C
+#define SII902X_TPI_REV_LEVEL_ID	0x1D
+#define SII902X_POWER_STATE	0x1E
+#define SII902X_TPI_AUDIO_CFG0	0x24
+#define SII902X_TPI_AUDIO_CFG1	0x25
+#define SII902X_TPI_AUDIO_CFG2	0x26
+#define SII902X_TPI_AUDIO_CFG3	0x27
+#define SII902X_TPI_HDCP_REV	0x30
+#define SII902X_TPI_INT_ENABLE	0x3C
+#define SII902X_TPI_INT_STATUS	0x3D
+#define SII902X_TPI_INT_PLUG_IN	BIT(2)
+#define SII902X_GENERAL_PURPOSE_IO0	0xBC
+#define SII902X_GENERAL_PURPOSE_IO1	0xBD
+#define SII902X_GENERAL_PURPOSE_IO2	0xBE
+#define SII902X_TRANS_MODE_DIFF	0xC7
+
+bool g_enable_hdmi;
+
+struct sii902x_data {
+	struct i2c_client *client;
+	struct delayed_work det_work;
+	struct fb_info *fbi;
+} *sii902x;
+
+#define to_sii902x_data(x) \
+	((struct sii902x_data *)to_encoder_slave(x)->slave_priv)
+
+static struct i2c_client *sii902x_to_i2c(struct sii902x_data *sii902x)
+{
+	return sii902x->client;
+}
+
+/* HW access functions */
+static s32 sii902x_write(const struct i2c_client *client,
+			 u8 command, u8 value)
+{
+	return i2c_smbus_write_byte_data(client, command, value);
+}
+
+static s32 sii902x_read(const struct i2c_client *client, u8 command)
+{
+	int val;
+
+	val = i2c_smbus_read_word_data(client, command);
+
+	return val & 0xff;
+}
+
+static void sii902x_poweron(void)
+{
+	/* Turn on DVI or HDMI */
+	sii902x_write(sii902x->client, SII902X_SYS_CONTROL, 0x00);
+}
+
+static void sii902x_poweroff(void)
+{
+	/* disable tmds before changing resolution */
+	sii902x_write(sii902x->client, SII902X_SYS_CONTROL, 0x10);
+}
+
+
+static void sii902x_chip_id(struct sii902x_data *sii902x)
+{
+	struct i2c_client *client = sii902x_to_i2c(sii902x);
+	int val;
+
+	/* read device ID */
+	val = sii902x_read(client, SII902X_TPI_FAMILY_DEV_ID);
+	pr_info("Sii902x: read id = 0x%02X", val);
+	val = sii902x_read(client, SII902X_TPI_DEV_REV_ID);
+	pr_info("-0x%02X", val);
+	val = sii902x_read(client, SII902X_TPI_REV_LEVEL_ID);
+	pr_info("-0x%02X", val);
+	val = sii902x_read(client, SII902X_TPI_HDCP_REV);
+	pr_info("-0x%02X\n", val);
+}
+
+static int sii902x_initialize(struct sii902x_data *sii902x)
+{
+	struct i2c_client *client = sii902x_to_i2c(sii902x);
+	int ret, cnt;
+
+	for (cnt = 0; cnt < 5; cnt++) {
+		/* Set 902x in hardware TPI mode on and jump out of D3 state */
+		ret = sii902x_write(client, SII902X_TRANS_MODE_DIFF, 0x00);
+		if (ret < 0)
+			break;
+	}
+	if (ret != 0)
+		dev_err(&client->dev, "cound not find device\n");
+
+	return ret;
+}
+
+static void sii902x_enable_source(struct sii902x_data *sii902x)
+{
+	struct i2c_client *client = sii902x_to_i2c(sii902x);
+	int val;
+
+	sii902x_write(client, SII902X_GENERAL_PURPOSE_IO0, 0x01);
+	sii902x_write(client, SII902X_GENERAL_PURPOSE_IO1, 0x82);
+	val = sii902x_read(client, SII902X_GENERAL_PURPOSE_IO2);
+	val |= 0x1;
+	sii902x_write(client, SII902X_GENERAL_PURPOSE_IO2, val);
+}
+
+static void sii902x_power_up_tx(struct sii902x_data *sii902x)
+{
+	struct i2c_client *client = sii902x_to_i2c(sii902x);
+	int val;
+
+	val = sii902x_read(client, SII902X_POWER_STATE);
+	val &= ~0x3;
+	sii902x_write(client, SII902X_POWER_STATE, val);
+}
+
+static int sii902x_get_edid_preconfig(void)
+{
+	int old, dat, ret = 0, cnt = 100;
+
+	old = sii902x_read(sii902x->client, SII902X_SYS_CONTROL);
+
+	sii902x_write(sii902x->client, SII902X_SYS_CONTROL,
+		      old | SII902X_SYS_CTR_DDC_REQ);
+	do {
+		cnt--;
+		msleep(20);
+		dat = sii902x_read(sii902x->client, SII902X_SYS_CONTROL);
+	} while ((!(dat & 0x2)) && cnt);
+
+	if (!cnt) {
+		ret = -1;
+		goto done;
+	}
+
+	sii902x_write(sii902x->client, SII902X_SYS_CONTROL,
+		      old | SII902X_SYS_CTR_DDC_BUS_AVAI);
+
+done:
+	sii902x_write(sii902x->client, SII902X_SYS_CONTROL, old);
+	return ret;
+}
+
+static int __init enable_hdmi_setup(char *str)
+{
+	g_enable_hdmi = true;
+
+	return 1;
+}
+
+__setup("hdmi", enable_hdmi_setup);
+
+static irqreturn_t sii902x_detect_handler(int irq, void *data)
+{
+	if (g_enable_hdmi)
+		g_enable_hdmi = false;
+
+	return IRQ_HANDLED;
+}
+
+static int sii902x_probe(struct i2c_client *client,
+			 const struct i2c_device_id *id)
+{
+	struct i2c_adapter *adap = to_i2c_adapter(client->dev.parent);
+	int ret, err;
+
+	if (!g_enable_hdmi)
+		return -EPERM;
+
+	if (!i2c_check_functionality(adap, I2C_FUNC_SMBUS_BYTE)) {
+		dev_err(&client->dev, "i2c_check_functionality error\n");
+		return -ENODEV;
+	}
+
+	sii902x = devm_kzalloc(&client->dev, sizeof(*sii902x), GFP_KERNEL);
+	if (!sii902x)
+		return -ENOMEM;
+
+	sii902x->client = client;
+	i2c_set_clientdata(client, sii902x);
+
+	err = sii902x_initialize(sii902x);
+	if (err)
+		return err;
+
+	sii902x_chip_id(sii902x);
+	sii902x_power_up_tx(sii902x);
+	sii902x_enable_source(sii902x);
+
+	if (sii902x_get_edid_preconfig() < 0)
+		dev_warn(&client->dev, "Read edid preconfig failed\n");
+
+	if (client->irq) {
+		ret = devm_request_irq(&client->dev, client->irq,
+				       sii902x_detect_handler, 0,
+				       "SII902x_det", sii902x);
+		if (ret < 0)
+			dev_warn(&client->dev,
+				 "cound not request det irq %d\n",
+				 client->irq);
+		else {
+			/*enable cable hot plug irq*/
+			sii902x_write(client, SII902X_TPI_INT_ENABLE, 0x01);
+		}
+	}
+
+	return 0;
+}
+
+static int sii902x_remove(struct i2c_client *client)
+{
+	sii902x_poweroff();
+	return 0;
+}
+
+/* DRM encoder functions */
+
+static void
+sii902x_encoder_dpms(struct drm_encoder *encoder, int mode)
+{
+	if (mode == DRM_MODE_DPMS_ON)
+		sii902x_poweron();
+	else
+		sii902x_poweroff();
+}
+
+
+static int
+sii902x_encoder_mode_valid(struct drm_encoder *encoder,
+			  struct drm_display_mode *mode)
+{
+	return 0;
+}
+
+static void
+sii902x_encoder_mode_set(struct drm_encoder *encoder,
+			struct drm_display_mode *mode,
+			struct drm_display_mode *adjusted_mode)
+{
+	struct videomode vm;
+	u16 data[4];
+	u32 refresh;
+	u8 *tmp;
+	int i;
+
+	/* Power up */
+	sii902x_power_up_tx(sii902x);
+
+	drm_display_mode_to_videomode(mode, &vm);
+	data[0] = PICOS2KHZ(vm.pixelclock) / 10;
+	data[2] = vm.hsync_len + vm.hback_porch +
+		  vm.hactive + vm.hfront_porch;
+	data[3] = vm.vsync_len + vm.vfront_porch +
+		  vm.vactive + vm.vback_porch;
+	refresh = data[2] * data[3];
+	refresh = (PICOS2KHZ(vm.pixelclock) * 1000) / refresh;
+	data[1] = refresh * 100;
+
+	tmp = (u8 *)data;
+	for (i = 0; i < 8; i++)
+		sii902x_write(sii902x->client, i, tmp[i]);
+
+	/* input bus/pixel: full pixel wide (24bit), rising edge */
+	sii902x_write(sii902x->client, SII902X_INPUT_BUS_FMT, 0x70);
+	/* Set input format to RGB */
+	sii902x_write(sii902x->client, SII902X_TPI_AVI_INPUT_FMT, 0x00);
+	/* set output format to RGB */
+	sii902x_write(sii902x->client, SII902X_TPI_AVI_OUTPUT_FMT, 0x00);
+	/* audio setup */
+	sii902x_write(sii902x->client, SII902X_TPI_AUDIO_CFG1, 0x00);
+	sii902x_write(sii902x->client, SII902X_TPI_AUDIO_CFG2, 0x40);
+	sii902x_write(sii902x->client, SII902X_TPI_AUDIO_CFG3, 0x00);
+}
+
+struct edid *sii902x_drm_get_edid(struct drm_connector *connector,
+				  struct i2c_adapter *adapter)
+{
+	int old, dat, cnt = 100;
+	struct edid *edid;
+
+	old = sii902x_read(sii902x->client, SII902X_SYS_CONTROL);
+
+	sii902x_write(sii902x->client, SII902X_SYS_CONTROL,
+		      old | SII902X_SYS_CTR_DDC_REQ);
+	do {
+		cnt--;
+		msleep(20);
+		dat = sii902x_read(sii902x->client, SII902X_SYS_CONTROL);
+	} while ((!(dat & 0x2)) && cnt);
+
+	if (!cnt) {
+		edid = NULL;
+		goto done;
+	}
+
+	sii902x_write(sii902x->client, SII902X_SYS_CONTROL,
+		      old | SII902X_SYS_CTR_DDC_BUS_AVAI);
+
+	/* edid reading */
+	edid = drm_get_edid(connector, adapter);
+
+	cnt = 100;
+	do {
+		cnt--;
+		sii902x_write(sii902x->client, SII902X_SYS_CONTROL,
+			      old & ~SII902X_SYS_CTR_DDC_BUS_AVAI);
+		msleep(20);
+		dat = sii902x_read(sii902x->client, SII902X_SYS_CONTROL);
+	} while ((dat & 0x6) && cnt);
+
+	if (!cnt)
+		edid = NULL;
+
+done:
+	sii902x_write(sii902x->client, SII902X_SYS_CONTROL, old);
+	return edid;
+}
+
+static int
+sii902x_encoder_get_modes(struct drm_encoder *encoder,
+			 struct drm_connector *connector)
+{
+	struct drm_device *dev = connector->dev;
+	struct i2c_adapter *adap = to_i2c_adapter(sii902x->client->dev.parent);
+	struct edid *edid;
+	struct drm_display_mode *mode;
+	int ret;
+
+	edid = sii902x_drm_get_edid(connector, adap);
+	if (edid) {
+		drm_mode_connector_update_edid_property(connector, edid);
+		ret = drm_add_edid_modes(connector, edid);
+		kfree(edid);
+	} else {
+		dev_dbg(dev->dev, "failed to get edid\n");
+	}
+
+	list_for_each_entry(mode, &connector->probed_modes, head) {
+		if (mode->hdisplay == 1024 || mode->vdisplay == 768)
+			mode->type |= DRM_MODE_TYPE_PREFERRED;
+		else
+			mode->type &= ~DRM_MODE_TYPE_PREFERRED;
+	}
+
+	return ret;
+}
+
+static struct drm_encoder_slave_funcs sii902x_encoder_funcs = {
+	.dpms = sii902x_encoder_dpms,
+	.mode_valid = sii902x_encoder_mode_valid,
+	.mode_set = sii902x_encoder_mode_set,
+	.get_modes = sii902x_encoder_get_modes,
+};
+static int
+sii902x_encoder_init(struct i2c_client *client,
+		    struct drm_device *dev,
+		    struct drm_encoder_slave *encoder)
+{
+
+	encoder->slave_funcs = &sii902x_encoder_funcs;
+
+	return 0;
+}
+static const struct i2c_device_id sii902x_id[] = {
+	{ "sii902x", 0 },
+	{},
+};
+MODULE_DEVICE_TABLE(i2c, sii902x_id);
+
+static const struct of_device_id sii902x_dt_ids[] = {
+	{ .compatible = "sil,sii9022a", },
+	{ /* sentinel */ }
+};
+MODULE_DEVICE_TABLE(of, sii902x_dt_ids);
+
+static struct drm_i2c_encoder_driver sii902x_driver = {
+	.i2c_driver = {
+		.probe = sii902x_probe,
+		.remove = sii902x_remove,
+		.driver = {
+			.name = "sii902x",
+			.owner = THIS_MODULE,
+			.of_match_table = sii902x_dt_ids,
+		},
+		.id_table = sii902x_id,
+	},
+	.encoder_init = sii902x_encoder_init,
+};
+
+/* Module initialization */
+
+static int __init sii902x_init(void)
+{
+	return drm_i2c_encoder_register(THIS_MODULE, &sii902x_driver);
+}
+
+static void __exit sii902x_exit(void)
+{
+	drm_i2c_encoder_unregister(&sii902x_driver);
+}
+
+
+MODULE_AUTHOR("Freescale Semiconductor, Inc.");
+MODULE_DESCRIPTION("SII902x DVI/HDMI driver");
+MODULE_LICENSE("GPL");
+
+
+module_init(sii902x_init);
+module_exit(sii902x_exit);