From patchwork Fri Nov 13 12:01:04 2015 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Enric Balletbo Serra X-Patchwork-Id: 7611031 Return-Path: X-Original-To: patchwork-dri-devel@patchwork.kernel.org Delivered-To: patchwork-parsemail@patchwork2.web.kernel.org Received: from mail.kernel.org (mail.kernel.org [198.145.29.136]) by patchwork2.web.kernel.org (Postfix) with ESMTP id 65B82BF90C for ; Fri, 13 Nov 2015 12:01:49 +0000 (UTC) Received: from mail.kernel.org (localhost [127.0.0.1]) by mail.kernel.org (Postfix) with ESMTP id D1DD620558 for ; Fri, 13 Nov 2015 12:01:42 +0000 (UTC) Received: from gabe.freedesktop.org (gabe.freedesktop.org [131.252.210.177]) by mail.kernel.org (Postfix) with ESMTP id E3987207DA for ; Fri, 13 Nov 2015 12:01:33 +0000 (UTC) Received: from gabe.freedesktop.org (localhost [127.0.0.1]) by gabe.freedesktop.org (Postfix) with ESMTP id 38C7A6EFD9; Fri, 13 Nov 2015 04:01:33 -0800 (PST) X-Original-To: dri-devel@lists.freedesktop.org Delivered-To: dri-devel@lists.freedesktop.org Received: from mail-wm0-f67.google.com (mail-wm0-f67.google.com [74.125.82.67]) by gabe.freedesktop.org (Postfix) with ESMTPS id 26A2E8A6CF for ; Fri, 13 Nov 2015 04:01:31 -0800 (PST) Received: by wmww144 with SMTP id w144so5151079wmw.1 for ; Fri, 13 Nov 2015 04:01:29 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20120113; h=from:to:cc:subject:date:message-id:in-reply-to:references; bh=iC8Cfcv0M3Qp2wU/LdYnBW6G/vxUxwxHYH/ycs2MUHw=; b=qoae7qBuR0uRLXt0FhU3YmWlppXCOOMW/EeeahYsR4dAYKkPeYRzlch43lY5qEagcQ qlW7itHX3/b6lLvM2U+F+KulthZ1jMuFi/hxLSXkwAA3CtO5utvefLSaUC81l6IzhgAY m0X+KwfUPPrJP276/to1DG8cXKJuaq9ruOa5naGJaSNhIl6zk8WDFqVCLHkiZ/uJYhkl X/fBaxj/ohnEteoV8KsGScq7W4NWkvZ0swxu9+ddjPnR/tcVnXa19jGk8ZAFu2Zg7+HV ik+A3zdwJAbu+IBKpZOJ8kz81jGSUrPVpJBvxRfjNrzQN5TKtRlEfZz3wlS5OjAKDXnZ 2kVw== X-Received: by 10.28.170.18 with SMTP id t18mr3561274wme.73.1447416089645; Fri, 13 Nov 2015 04:01:29 -0800 (PST) Received: from localhost.localdomain ([84.236.220.225]) by smtp.gmail.com with ESMTPSA id i18sm3657634wmf.6.2015.11.13.04.01.26 (version=TLS1_2 cipher=ECDHE-RSA-AES128-SHA bits=128/128); Fri, 13 Nov 2015 04:01:28 -0800 (PST) From: Enric Balletbo i Serra X-Google-Original-From: Enric Balletbo i Serra To: devicetree@vger.kernel.org, linux-kernel@vger.kernel.org, dri-devel@lists.freedesktop.org, devel@driverdev.osuosl.org Subject: [PATCHv5 3/3] drm: bridge: anx78xx: Add anx78xx driver support by analogix. Date: Fri, 13 Nov 2015 13:01:04 +0100 Message-Id: <1447416064-24989-4-git-send-email-enric.balletbo@collabora.com> X-Mailer: git-send-email 2.1.0 In-Reply-To: <1447416064-24989-1-git-send-email-enric.balletbo@collabora.com> References: <1447416064-24989-1-git-send-email-enric.balletbo@collabora.com> Cc: mark.rutland@arm.com, drinkcat@chromium.org, laurent.pinchart@ideasonboard.com, pawel.moll@arm.com, ijc+devicetree@hellion.org.uk, gregkh@linuxfoundation.org, cawa.cheng@mediatek.com, jb.tsai@mediatek.com, sjoerd.simons@collabora.co.uk, robh+dt@kernel.org, span@analogixsemi.com, galak@codeaurora.org, javier@dowhile0.org, eddie.huang@mediatek.com, cjiao@analogixsemi.com, dan.carpenter@oracle.com, nathan.chung@mediatek.com X-BeenThere: dri-devel@lists.freedesktop.org X-Mailman-Version: 2.1.18 Precedence: list List-Id: Direct Rendering Infrastructure - Development List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , MIME-Version: 1.0 Errors-To: dri-devel-bounces@lists.freedesktop.org Sender: "dri-devel" X-Spam-Status: No, score=-4.4 required=5.0 tests=BAYES_00, DKIM_ADSP_CUSTOM_MED, DKIM_SIGNED, FREEMAIL_FROM, RCVD_IN_DNSWL_MED, RP_MATCHES_RCVD, T_DKIM_INVALID, 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 At the moment it only supports ANX7814. The ANX7814 is an ultra-low power Full-HD (1080p60) SlimPort transmitter designed for portable devices. This driver adds initial support and supports HDMI to DP pass-through mode. Signed-off-by: Enric Balletbo i Serra --- drivers/gpu/drm/bridge/Kconfig | 2 + drivers/gpu/drm/bridge/Makefile | 1 + drivers/gpu/drm/bridge/anx78xx/Kconfig | 5 + drivers/gpu/drm/bridge/anx78xx/Makefile | 4 + drivers/gpu/drm/bridge/anx78xx/anx78xx.h | 45 + drivers/gpu/drm/bridge/anx78xx/anx78xx_main.c | 347 +++ drivers/gpu/drm/bridge/anx78xx/slimport_tx_drv.c | 3226 ++++++++++++++++++++++ drivers/gpu/drm/bridge/anx78xx/slimport_tx_drv.h | 149 + drivers/gpu/drm/bridge/anx78xx/slimport_tx_reg.h | 754 +++++ 9 files changed, 4533 insertions(+) create mode 100644 drivers/gpu/drm/bridge/anx78xx/Kconfig create mode 100644 drivers/gpu/drm/bridge/anx78xx/Makefile create mode 100644 drivers/gpu/drm/bridge/anx78xx/anx78xx.h create mode 100644 drivers/gpu/drm/bridge/anx78xx/anx78xx_main.c create mode 100644 drivers/gpu/drm/bridge/anx78xx/slimport_tx_drv.c create mode 100644 drivers/gpu/drm/bridge/anx78xx/slimport_tx_drv.h create mode 100644 drivers/gpu/drm/bridge/anx78xx/slimport_tx_reg.h diff --git a/drivers/gpu/drm/bridge/Kconfig b/drivers/gpu/drm/bridge/Kconfig index 2de52a5..aa6fe12 100644 --- a/drivers/gpu/drm/bridge/Kconfig +++ b/drivers/gpu/drm/bridge/Kconfig @@ -29,4 +29,6 @@ config DRM_PARADE_PS8622 ---help--- Parade eDP-LVDS bridge chip driver. +source "drivers/gpu/drm/bridge/anx78xx/Kconfig" + endmenu diff --git a/drivers/gpu/drm/bridge/Makefile b/drivers/gpu/drm/bridge/Makefile index e2eef1c..e5bd38b 100644 --- a/drivers/gpu/drm/bridge/Makefile +++ b/drivers/gpu/drm/bridge/Makefile @@ -3,3 +3,4 @@ ccflags-y := -Iinclude/drm obj-$(CONFIG_DRM_DW_HDMI) += dw_hdmi.o obj-$(CONFIG_DRM_NXP_PTN3460) += nxp-ptn3460.o obj-$(CONFIG_DRM_PARADE_PS8622) += parade-ps8622.o +obj-$(CONFIG_DRM_ANX78XX) += anx78xx/ diff --git a/drivers/gpu/drm/bridge/anx78xx/Kconfig b/drivers/gpu/drm/bridge/anx78xx/Kconfig new file mode 100644 index 0000000..7537673 --- /dev/null +++ b/drivers/gpu/drm/bridge/anx78xx/Kconfig @@ -0,0 +1,5 @@ +config DRM_ANX78XX + tristate "Analogix ANX78XX bridge" + help + ANX78XX is a HD video transmitter chip over micro-USB + connector for smartphone device. diff --git a/drivers/gpu/drm/bridge/anx78xx/Makefile b/drivers/gpu/drm/bridge/anx78xx/Makefile new file mode 100644 index 0000000..a843733 --- /dev/null +++ b/drivers/gpu/drm/bridge/anx78xx/Makefile @@ -0,0 +1,4 @@ +obj-${CONFIG_DRM_ANX78XX} := anx78xx.o + +anx78xx-y += anx78xx_main.o +anx78xx-y += slimport_tx_drv.o diff --git a/drivers/gpu/drm/bridge/anx78xx/anx78xx.h b/drivers/gpu/drm/bridge/anx78xx/anx78xx.h new file mode 100644 index 0000000..ff8bbe8 --- /dev/null +++ b/drivers/gpu/drm/bridge/anx78xx/anx78xx.h @@ -0,0 +1,45 @@ +/* + * Copyright(c) 2015, Analogix Semiconductor. All rights reserved. + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 and + * only version 2 as published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + */ + +#ifndef __ANX78xx_H +#define __ANX78xx_H + +#include +#include +#include +#include +#include + +#include + +struct anx78xx_platform_data { + struct gpio_desc *gpiod_cable_det; + struct gpio_desc *gpiod_pd; + struct gpio_desc *gpiod_reset; + struct gpio_desc *gpiod_v10; +}; + +struct anx78xx { + struct drm_bridge bridge; + struct i2c_client *client; + struct anx78xx_platform_data *pdata; + struct delayed_work work; + struct workqueue_struct *workqueue; +}; + +void anx78xx_poweron(struct anx78xx *data); +void anx78xx_poweroff(struct anx78xx *data); +bool anx78xx_cable_is_detected(struct anx78xx *anx78xx); + +#endif diff --git a/drivers/gpu/drm/bridge/anx78xx/anx78xx_main.c b/drivers/gpu/drm/bridge/anx78xx/anx78xx_main.c new file mode 100644 index 0000000..4ea1274 --- /dev/null +++ b/drivers/gpu/drm/bridge/anx78xx/anx78xx_main.c @@ -0,0 +1,347 @@ +/* + * Copyright(c) 2015, Analogix Semiconductor. All rights reserved. + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 and + * only version 2 as published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + */ +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "anx78xx.h" +#include "slimport_tx_drv.h" + +void anx78xx_poweron(struct anx78xx *anx78xx) +{ + struct anx78xx_platform_data *pdata = anx78xx->pdata; + + if (pdata->gpiod_v10) { + gpiod_set_value_cansleep(pdata->gpiod_v10, 1); + usleep_range(1000, 2000); + } + + gpiod_set_value_cansleep(pdata->gpiod_reset, 0); + usleep_range(1000, 2000); + + gpiod_set_value_cansleep(pdata->gpiod_pd, 0); + usleep_range(1000, 2000); + + gpiod_set_value_cansleep(pdata->gpiod_reset, 1); +} + +void anx78xx_poweroff(struct anx78xx *anx78xx) +{ + struct anx78xx_platform_data *pdata = anx78xx->pdata; + + if (pdata->gpiod_v10) { + gpiod_set_value_cansleep(pdata->gpiod_v10, 0); + usleep_range(1000, 2000); + } + + gpiod_set_value_cansleep(pdata->gpiod_reset, 0); + usleep_range(1000, 2000); + + gpiod_set_value_cansleep(pdata->gpiod_pd, 1); + usleep_range(1000, 2000); +} + +static int anx78xx_init_gpio(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + struct anx78xx_platform_data *pdata = anx78xx->pdata; + + /* gpio for cable detection */ + pdata->gpiod_cable_det = devm_gpiod_get(dev, "cable-det", GPIOD_IN); + if (IS_ERR(pdata->gpiod_cable_det)) { + dev_err(dev, "unable to claim cable-det gpio\n"); + return PTR_ERR(pdata->gpiod_cable_det); + } + + /* gpio for chip power down */ + pdata->gpiod_pd = devm_gpiod_get(dev, "pd", GPIOD_OUT_HIGH); + if (IS_ERR(pdata->gpiod_pd)) { + dev_err(dev, "unable to claim pd gpio\n"); + return PTR_ERR(pdata->gpiod_pd); + } + + /* gpio for chip reset */ + pdata->gpiod_reset = devm_gpiod_get(dev, "reset", GPIOD_OUT_LOW); + if (IS_ERR(pdata->gpiod_reset)) { + dev_err(dev, "unable to claim reset gpio\n"); + return PTR_ERR(pdata->gpiod_reset); + } + + /* gpio for V10 power control */ + pdata->gpiod_v10 = devm_gpiod_get_optional(dev, "v10", GPIOD_OUT_LOW); + if (IS_ERR(pdata->gpiod_v10)) { + dev_err(dev, "unable to claim v10 gpio\n"); + return PTR_ERR(pdata->gpiod_v10); + } + + return 0; +} + +bool anx78xx_cable_is_detected(struct anx78xx *anx78xx) +{ + int i, count = 0; + + for (i = 0; i < 10; i++) { + if (gpiod_get_value(anx78xx->pdata->gpiod_cable_det)) + count++; + mdelay(5); + } + + return (count > 5); +} + +/* + * HPD IRQ Event: HPD pulse width greater than 0.25ms but narrower than 2ms + * Hot Unplug Event: HPD pulse stays low longer than 2ms. + * + * AP just monitor HPD pulse high in this irq. If HPD is high, the driver + * will power on the chip, and then the driver controls when to power down + * the chip, if HPD event is HPD IRQ, the driver deals with IRQ event from + * downstream, finally, if HPD event is Hot Plug, the driver power down the + * chip. + */ +static irqreturn_t anx78xx_cable_isr(int irq, void *data) +{ + struct anx78xx *anx78xx = data; + + queue_delayed_work(anx78xx->workqueue, &anx78xx->work, 0); + + return IRQ_HANDLED; +} + +static void anx78xx_work_func(struct work_struct *work) +{ + struct anx78xx *anx78xx = container_of(work, struct anx78xx, + work.work); + + if (sp_main_process(anx78xx)) + queue_delayed_work(anx78xx->workqueue, &anx78xx->work, + msecs_to_jiffies(500)); + else + cancel_delayed_work(&anx78xx->work); +} + +static inline struct anx78xx *bridge_to_anx78xx(struct drm_bridge *bridge) +{ + return container_of(bridge, struct anx78xx, bridge); +} + +static int anx78xx_bridge_attach(struct drm_bridge *bridge) +{ + return 0; +} + +static bool anx78xx_bridge_mode_fixup(struct drm_bridge *bridge, + const struct drm_display_mode *mode, + struct drm_display_mode *adjusted_mode) +{ + struct anx78xx *anx78xx = bridge_to_anx78xx(bridge); + + dev_dbg(&anx78xx->client->dev, "mode_fixup %d<%d; %d; %d\n", + sp_get_link_bandwidth(anx78xx), SP_LINK_5P4G, + mode->clock, mode->flags & DRM_MODE_FLAG_INTERLACE); + + if (mode->flags & DRM_MODE_FLAG_INTERLACE) + return false; + + /* Max 720p at 2.7 Ghz, one lane */ + if (sp_get_link_bandwidth(anx78xx) < SP_LINK_5P4G && + mode->clock > 74250) + return false; + + /* Max 1200p at 5.4 Ghz, one lane */ + if (mode->clock > 154000) + return false; + + return true; +} + +static const struct drm_bridge_funcs anx78xx_bridge_funcs = { + .attach = anx78xx_bridge_attach, + .mode_fixup = anx78xx_bridge_mode_fixup, +}; + +static int anx78xx_i2c_probe(struct i2c_client *client, + const struct i2c_device_id *id) +{ + struct anx78xx *anx78xx; + int ret; + + if (!i2c_check_functionality(client->adapter, + I2C_FUNC_SMBUS_I2C_BLOCK)) { + dev_err(&client->dev, "i2c bus does not support the device\n"); + return -ENODEV; + } + + anx78xx = devm_kzalloc(&client->dev, sizeof(*anx78xx), GFP_KERNEL); + if (!anx78xx) + return -ENOMEM; + + anx78xx->pdata = devm_kzalloc(&client->dev, + sizeof(struct anx78xx_platform_data), + GFP_KERNEL); + if (!anx78xx->pdata) + return -ENOMEM; + + anx78xx->bridge.of_node = client->dev.of_node; + anx78xx->bridge.funcs = &anx78xx_bridge_funcs; + ret = drm_bridge_add(&anx78xx->bridge); + if (ret < 0) { + dev_err(&client->dev, "add drm bridge failed\n"); + return ret; + } + + anx78xx->client = client; + + i2c_set_clientdata(client, anx78xx); + + ret = anx78xx_init_gpio(anx78xx); + if (ret) { + dev_err(&client->dev, "failed to initialize gpios\n"); + goto fail_remove_bridge; + } + + INIT_DELAYED_WORK(&anx78xx->work, anx78xx_work_func); + + anx78xx->workqueue = create_singlethread_workqueue("anx78xx_work"); + if (!anx78xx->workqueue) { + dev_err(&client->dev, "failed to create work queue\n"); + ret = -ENOMEM; + goto fail_remove_bridge; + } + + ret = sp_system_init(anx78xx); + if (ret) { + dev_err(&client->dev, "failed to initialize anx78xx\n"); + goto fail_free_wq; + } + + client->irq = gpiod_to_irq(anx78xx->pdata->gpiod_cable_det); + if (client->irq < 0) { + dev_err(&client->dev, "failed to get irq: %d\n", client->irq); + ret = client->irq; + goto fail_free_wq; + } + + ret = request_threaded_irq(client->irq, NULL, anx78xx_cable_isr, + IRQF_TRIGGER_RISING | + IRQF_TRIGGER_FALLING | + IRQF_ONESHOT, "anx78xx", anx78xx); + if (ret) { + dev_err(&client->dev, "failed to request threaded irq\n"); + goto fail_free_wq; + } + + ret = irq_set_irq_wake(client->irq, 1); + if (ret) { + dev_err(&client->dev, "failed to set irq wake\n"); + goto fail_free_wq; + } + + ret = enable_irq_wake(client->irq); + if (ret) { + dev_err(&client->dev, "failed to enable irq wake\n"); + goto fail_free_wq; + } + + /* enable driver */ + queue_delayed_work(anx78xx->workqueue, &anx78xx->work, 0); + + return 0; + +fail_free_wq: + destroy_workqueue(anx78xx->workqueue); +fail_remove_bridge: + drm_bridge_remove(&anx78xx->bridge); + return ret; +} + +static int anx78xx_i2c_remove(struct i2c_client *client) +{ + struct anx78xx *anx78xx = i2c_get_clientdata(client); + + destroy_workqueue(anx78xx->workqueue); + drm_bridge_remove(&anx78xx->bridge); + + return 0; +} + +static int anx78xx_i2c_suspend(struct device *dev) +{ + struct i2c_client *client = container_of(dev, struct i2c_client, dev); + struct anx78xx *anx78xx = i2c_get_clientdata(client); + + if (anx78xx_cable_is_detected(anx78xx)) { + cancel_delayed_work_sync(&anx78xx->work); + flush_workqueue(anx78xx->workqueue); + anx78xx_poweroff(anx78xx); + } + + return 0; +} + +static int anx78xx_i2c_resume(struct device *dev) +{ + struct i2c_client *client = container_of(dev, struct i2c_client, dev); + struct anx78xx *anx78xx = i2c_get_clientdata(client); + + if (anx78xx_cable_is_detected(anx78xx)) + queue_delayed_work(anx78xx->workqueue, &anx78xx->work, 0); + + return 0; +} + +static SIMPLE_DEV_PM_OPS(anx78xx_i2c_pm_ops, + anx78xx_i2c_suspend, anx78xx_i2c_resume); + +static const struct i2c_device_id anx78xx_id[] = { + {"anx7814", 0}, + { /* sentinel */ } +}; + +MODULE_DEVICE_TABLE(i2c, anx78xx_id); + +#ifdef CONFIG_OF +static const struct of_device_id anx78xx_match_table[] = { + {.compatible = "analogix,anx7814",}, + { /* sentinel */ }, +}; +MODULE_DEVICE_TABLE(of, anx78xx_match_table); +#endif + +static struct i2c_driver anx78xx_driver = { + .driver = { + .name = "anx7814", + .pm = &anx78xx_i2c_pm_ops, +#ifdef CONFIG_OF + .of_match_table = of_match_ptr(anx78xx_match_table), +#endif + }, + .probe = anx78xx_i2c_probe, + .remove = anx78xx_i2c_remove, + .id_table = anx78xx_id, +}; + +module_i2c_driver(anx78xx_driver); + +MODULE_DESCRIPTION("Slimport transmitter ANX78XX driver"); +MODULE_AUTHOR("Junhua Xia "); +MODULE_LICENSE("GPL v2"); +MODULE_VERSION("1.1"); diff --git a/drivers/gpu/drm/bridge/anx78xx/slimport_tx_drv.c b/drivers/gpu/drm/bridge/anx78xx/slimport_tx_drv.c new file mode 100644 index 0000000..2d9ec0f --- /dev/null +++ b/drivers/gpu/drm/bridge/anx78xx/slimport_tx_drv.c @@ -0,0 +1,3226 @@ +/* + * Copyright(c) 2015, Analogix Semiconductor. All rights reserved. + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 and + * only version 2 as published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + */ + +#include +#include + +#include +#include + +#include "anx78xx.h" +#include "slimport_tx_drv.h" + +#define XTAL_27M 270 +#define XTAL_CLK XTAL_27M + +struct slimport { + bool hdcp_enabled; /* HDCP control enable/ disable from AP */ + + u8 tx_test_bw; + bool tx_test_lt; + bool tx_test_edid; + + u8 changed_bandwidth; + + bool need_clean_status; + + u8 hdcp_error_count; + u8 hdcp_fail_count; + u8 audio_stable_count; /* Audio stable counter */ + + u8 edid_blocks[EDID_LENGTH]; + + bool read_edid_flag; + + bool down_sample_en; + + struct packet_audio tx_packet_audio; + struct packet_avi tx_packet_avi; + struct packet_mpeg tx_packet_mpeg; + struct packet_vsi tx_packet_vsi; + + /* Interrupt status registers */ + u8 common_int[4]; + u8 dp_int; + u8 sp_hdmi_int[7]; + + enum sp_tx_state tx_system_state; + enum audio_output_status tx_ao_state; + enum video_output_status tx_vo_state; + enum sp_tx_lt_status tx_lt_state; + enum hdcp_status hdcp_state; + enum repeater_status repeater_state; +}; + +static struct slimport sp; + +static const u16 chipid_list[] = { + 0x7802, + 0x7806, + 0x7810, + 0x7812, + 0x7814, + 0x7816, + 0x7818, +}; + +static void sp_hdmi_new_vsi_int(struct anx78xx *anx78xx); +static void sp_print_system_state(struct anx78xx *anx78xx, + enum sp_tx_state state); +static void sp_show_information(struct anx78xx *anx78xx); +static void sp_variable_init(void); + +/** + * sp_reg_read: Read ai value from a single register. + * + * @anx78xx: Device to read from. + * @addr: Address to read from. + * @reg: Register to be read from. + * @val: Pointer to store read value. + * + * A value of zero will be returned on success, a negative errno will + * be returned in error cases. + */ +static int sp_reg_read(struct anx78xx *anx78xx, u8 addr, u8 offset, u8 *val) +{ + int ret; + struct i2c_client *client = anx78xx->client; + + client->addr = addr >> 1; + + ret = i2c_smbus_read_byte_data(client, offset); + if (ret < 0) { + dev_err(&client->dev, "failed to read i2c addr=%x\n", addr); + return ret; + } + + *val = ret; + + return 0; +} + +/** + * sp_reg_write(): Write a value to a single register + * + * @anx78xx: Device to read from. + * @addr: Address to write to. + * @offset: Byte interpreted by slave. + * @val: Value to be written. + * + * A value of zero will be returned on success, a negative errno will + * be returned in error cases. + */ +static int sp_reg_write(struct anx78xx *anx78xx, u8 addr, u8 offset, u8 val) +{ + int ret; + struct i2c_client *client = anx78xx->client; + + client->addr = addr >> 1; + + ret = i2c_smbus_write_byte_data(client, offset, val); + if (ret < 0) + dev_err(&client->dev, "failed to write i2c addr=%x\n", addr); + + return ret; +} + +/** + * sp_reg_update_bits: Perform a read/modify/write cycle on the register. + * + * @anx78xx: Device to read from. + * @addr: Address to write to. + * @offset: Byte interpreted by slave. + * @mask: Bitmask to change. + * @val: New value for bitmask. + * + * Returns zero for success, a negative number on error. + */ +static int sp_reg_update_bits(struct anx78xx *anx78xx, u8 addr, u8 offset, + u8 mask, u8 val) +{ + int ret; + u8 orig, tmp; + + ret = sp_reg_read(anx78xx, addr, offset, &orig); + if (ret < 0) + return ret; + + tmp = orig & ~mask; + tmp |= val & mask; + + return sp_reg_write(anx78xx, addr, offset, tmp); +} + +/** + * sp_reg_set_bits: Perform a read/write cycle to set bits in register. + * + * @anx78xx: Device to read from. + * @addr: Address to write to. + * @offset: Byte interpreted by slave. + * @mask: Bitmask to change. + * + * Returns zero for success, a negative number on error. + */ +static inline int sp_reg_set_bits(struct anx78xx *anx78xx, u8 addr, + u8 offset, u8 mask) +{ + return sp_reg_update_bits(anx78xx, addr, offset, mask, mask); +} + +/** + * sp_reg_clear_bits: Perform a read/write cycle to clear bits in register. + * + * @anx78xx: Device to read from. + * @addr: Address to write to. + * @offset: Byte interpreted by slave. + * @mask: Bitmask to change. + * + * Returns zero for success, a negative number on error. + */ +static inline int sp_reg_clear_bits(struct anx78xx *anx78xx, u8 addr, + u8 offset, u8 mask) +{ + return sp_reg_update_bits(anx78xx, addr, offset, mask, 0); +} + +static inline void sp_video_mute(struct anx78xx *anx78xx, bool enable) +{ + if (enable) + sp_reg_set_bits(anx78xx, TX_P2, SP_VID_CTRL1_REG, + SP_VIDEO_MUTE); + else + sp_reg_clear_bits(anx78xx, TX_P2, SP_VID_CTRL1_REG, + SP_VIDEO_MUTE); +} + +static inline void sp_hdmi_mute_audio(struct anx78xx *anx78xx, bool enable) +{ + if (enable) + sp_reg_set_bits(anx78xx, RX_P0, SP_HDMI_MUTE_CTRL_REG, + SP_AUD_MUTE); + else + sp_reg_clear_bits(anx78xx, RX_P0, SP_HDMI_MUTE_CTRL_REG, + SP_AUD_MUTE); +} + +static inline void sp_hdmi_mute_video(struct anx78xx *anx78xx, bool enable) +{ + if (enable) + sp_reg_set_bits(anx78xx, RX_P0, SP_HDMI_MUTE_CTRL_REG, + SP_VID_MUTE); + else + sp_reg_clear_bits(anx78xx, RX_P0, SP_HDMI_MUTE_CTRL_REG, + SP_VID_MUTE); +} + +static inline void sp_addronly_set(struct anx78xx *anx78xx, bool enable) +{ + if (enable) + sp_reg_set_bits(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL2_REG, + SP_ADDR_ONLY); + else + sp_reg_clear_bits(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL2_REG, + SP_ADDR_ONLY); +} + +static inline void sp_set_link_bw(struct anx78xx *anx78xx, u8 bw) +{ + sp_reg_write(anx78xx, TX_P0, SP_DP_MAIN_LINK_BW_SET_REG, bw); +} + +static inline u8 sp_get_link_bw(struct anx78xx *anx78xx) +{ + u8 val; + + sp_reg_read(anx78xx, TX_P0, SP_DP_MAIN_LINK_BW_SET_REG, &val); + + return val & SP_LINK_BW_SET_MASK; +} + +static inline bool sp_get_pll_lock_status(struct anx78xx *anx78xx) +{ + u8 val; + + sp_reg_read(anx78xx, TX_P0, SP_DP_DEBUG1_REG, &val); + + return (val & SP_DEBUG_PLL_LOCK) != 0; +} + +static inline void sp_gen_m_clk_with_downspreading(struct anx78xx *anx78xx) +{ + sp_reg_set_bits(anx78xx, TX_P0, SP_DP_M_CALCULATION_CTRL_REG, + SP_M_GEN_CLK_SEL); +} + +static inline void sp_gen_m_clk_without_downspreading(struct anx78xx *anx78xx) +{ + sp_reg_clear_bits(anx78xx, TX_P0, SP_DP_M_CALCULATION_CTRL_REG, + SP_M_GEN_CLK_SEL); +} + +static inline void sp_hdmi_set_hpd(struct anx78xx *anx78xx, bool enable) +{ + if (enable) + sp_reg_set_bits(anx78xx, TX_P2, SP_VID_CTRL3_REG, SP_HPD_OUT); + else + sp_reg_clear_bits(anx78xx, TX_P2, SP_VID_CTRL3_REG, + SP_HPD_OUT); +} + +static inline void sp_hdmi_set_termination(struct anx78xx *anx78xx, + bool enable) +{ + if (enable) + sp_reg_clear_bits(anx78xx, RX_P0, SP_TMDS_CTRL_BASE + 7, + SP_PD_RT); + else + sp_reg_set_bits(anx78xx, RX_P0, SP_TMDS_CTRL_BASE + 7, + SP_PD_RT); +} + +static inline bool sp_hdcp_repeater_mode(struct anx78xx *anx78xx) +{ + u8 val; + + sp_reg_read(anx78xx, RX_P1, SP_HDCP_BCAPS_SHADOW_REG, &val); + + return (val & SP_BCAPS_REPEATER); +} + +static inline void sp_clean_hdcp_status(struct anx78xx *anx78xx) +{ + sp_reg_write(anx78xx, TX_P0, SP_HDCP_CTRL0_REG, + SP_BKSV_SRM_PASS | SP_KSVLIST_VLD); + sp_reg_set_bits(anx78xx, TX_P0, SP_HDCP_CTRL0_REG, SP_RE_AUTH); + usleep_range(2000, 4000); +} + +static const u8 dp_tx_output_precise_tune_bits[20] = { + 0x01, 0x03, 0x07, 0x7f, 0x71, 0x6b, 0x7f, + 0x73, 0x7f, 0x7f, 0x00, 0x00, 0x00, 0x00, + 0x0c, 0x42, 0x1e, 0x3e, 0x72, 0x7e, +}; + +static void sp_link_phy_initialization(struct anx78xx *anx78xx) +{ + int i; + + /* + * REVISIT : It is writing to a RESERVED bits in Analog Control 0 + * register. + */ + sp_reg_write(anx78xx, TX_P2, SP_ANALOG_CTRL0_REG, 0x02); + + /* + * Write DP TX output emphasis precise tune bits. + */ + for (i = 0; i < ARRAY_SIZE(dp_tx_output_precise_tune_bits); i++) + sp_reg_write(anx78xx, TX_P1, SP_DP_TX_LT_CTRL0_REG + i, + dp_tx_output_precise_tune_bits[i]); +} + +static void sp_set_system_state(struct anx78xx *anx78xx, + enum sp_tx_state new_state) +{ + u8 val; + struct device *dev = &anx78xx->client->dev; + + if ((sp.tx_system_state >= STATE_LINK_TRAINING) && + (new_state < STATE_LINK_TRAINING)) + sp_reg_set_bits(anx78xx, TX_P0, SP_DP_ANALOG_POWER_DOWN_REG, + SP_CH0_PD); + + dev_dbg(dev, "<< System State Transiton A -> B:\n"); + dev_dbg(dev, "<< A:\n"); + sp_print_system_state(anx78xx, sp.tx_system_state); + dev_dbg(dev, "<< B:\n"); + sp_print_system_state(anx78xx, new_state); + + if (sp.tx_system_state >= STATE_LINK_TRAINING) { + if (new_state >= STATE_AUDIO_OUTPUT) { + sp_hdmi_mute_audio(anx78xx, true); + } else { + sp_hdmi_mute_video(anx78xx, true); + sp_video_mute(anx78xx, true); + } + } + + if (!sp_hdcp_repeater_mode(anx78xx)) { + if (sp.tx_system_state >= STATE_HDCP_AUTH && + new_state <= STATE_HDCP_AUTH) { + sp_reg_read(anx78xx, TX_P0, SP_HDCP_CTRL0_REG, &val); + if (val & ~(SP_KSVLIST_VLD | SP_BKSV_SRM_PASS)) + sp_clean_hdcp_status(anx78xx); + } + } else { + if (sp.tx_system_state > STATE_LINK_TRAINING && + new_state <= STATE_LINK_TRAINING) { + /* Inform AP to re-auth */ + sp_hdmi_set_hpd(anx78xx, false); + sp_hdmi_set_termination(anx78xx, false); + msleep(50); + } + } + + sp.tx_system_state = new_state; + sp.hdcp_state = HDCP_CAPABLE_CHECK; + sp.tx_lt_state = LT_INIT; + sp.tx_vo_state = VO_WAIT_VIDEO_STABLE; + /* Reset audio stable counter */ + sp.audio_stable_count = 0; +} + +static inline void sp_reg_hardware_reset(struct anx78xx *anx78xx) +{ + sp_reg_set_bits(anx78xx, TX_P2, SP_RESET_CTRL1_REG, SP_HW_RST); + sp_variable_init(); + sp_set_system_state(anx78xx, STATE_SP_INITIALIZED); + msleep(500); +} + +static inline void sp_write_dpcd_addr(struct anx78xx *anx78xx, u8 addrh, + u8 addrm, u8 addrl) +{ + sp_reg_write(anx78xx, TX_P0, SP_AUX_ADDR_7_0_REG, addrl); + sp_reg_write(anx78xx, TX_P0, SP_AUX_ADDR_15_8_REG, addrm); + + /* + * DP AUX CH Address Register #2, only update bits[3:0] + * [7:4] RESERVED + * [3:0] AUX_ADDR[19:16], Register control AUX CH address. + */ + sp_reg_update_bits(anx78xx, TX_P0, SP_AUX_ADDR_19_16_REG, + SP_AUX_ADDR_19_16_MASK, addrh); +} + +static int sp_wait_aux_op_finish(struct anx78xx *anx78xx) +{ + u8 errcnt; + u8 val; + struct device *dev = &anx78xx->client->dev; + + errcnt = 150; + while (errcnt--) { + sp_reg_read(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL2_REG, &val); + if (!(val & SP_AUX_EN)) + break; + usleep_range(2000, 4000); + } + + if (!errcnt) { + dev_err(dev, "aux operate failed!\n"); + return -1; + } + + sp_reg_read(anx78xx, TX_P0, SP_AUX_CH_STATUS_REG, &val); + if (val & SP_AUX_STATUS) { + dev_err(dev, "wait aux operation status %.2x\n", val); + return -1; + } + + return 0; +} + +static void sp_print_system_state(struct anx78xx *anx78xx, + enum sp_tx_state state) +{ + struct device *dev = &anx78xx->client->dev; + + switch (state) { + case STATE_WAITING_CABLE_PLUG: + dev_dbg(dev, "-- WAITING CABLE PLUG --\n"); + break; + case STATE_SP_INITIALIZED: + dev_dbg(dev, "-- SP INITIALIZED --\n"); + break; + case STATE_SINK_CONNECTION: + dev_dbg(dev, "-- SINK CONNECTION --\n"); + break; + case STATE_PARSE_EDID: + dev_dbg(dev, "-- PARSE EDID --\n"); + break; + case STATE_LINK_TRAINING: + dev_dbg(dev, "-- LINK TRAINING --\n"); + break; + case STATE_VIDEO_OUTPUT: + dev_dbg(dev, "-- VIDEO OUTPUT --\n"); + break; + case STATE_HDCP_AUTH: + dev_dbg(dev, "-- HDCP AUTH --\n"); + break; + case STATE_AUDIO_OUTPUT: + dev_dbg(dev, "-- AUDIO OUTPUT --\n"); + break; + case STATE_PLAY_BACK: + dev_dbg(dev, "-- PLAY BACK --\n"); + break; + default: + dev_err(dev, "-- UNKNOWN! --\n"); + break; + } +} + +static void sp_reset_aux(struct anx78xx *anx78xx) +{ + sp_reg_set_bits(anx78xx, TX_P2, SP_RESET_CTRL2_REG, SP_AUX_RST); + sp_reg_clear_bits(anx78xx, TX_P2, SP_RESET_CTRL2_REG, SP_AUX_RST); +} + +static u8 sp_aux_dpcdread_bytes(struct anx78xx *anx78xx, u8 addrh, + u8 addrm, u8 addrl, u8 count, u8 *buf) +{ + u8 val, val1, i; + struct device *dev = &anx78xx->client->dev; + + sp_reg_write(anx78xx, TX_P0, SP_BUF_DATA_COUNT_REG, SP_BUF_CLR); + + sp_reg_write(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL1_REG, + ((count - 1) << SP_AUX_LENGTH_SHIFT) | 0x09); + sp_write_dpcd_addr(anx78xx, addrh, addrm, addrl); + sp_reg_set_bits(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL2_REG, SP_AUX_EN); + usleep_range(2000, 4000); + + if (sp_wait_aux_op_finish(anx78xx)) { + dev_err(dev, "aux read failed\n"); + sp_reg_read(anx78xx, TX_P2, SP_DP_INT_STATUS_REG, &val); + sp_reg_read(anx78xx, TX_P0, SP_DP_DEBUG1_REG, &val1); + if (!(val1 & SP_POLLING_EN) || (val & SP_POLLING_ERR)) + sp_reset_aux(anx78xx); + return -1; + } + + for (i = 0; i < count; i++) { + sp_reg_read(anx78xx, TX_P0, SP_DP_BUF_DATA0_REG + i, &val); + buf[i] = val; + } + + return 0; +} + +static int sp_aux_dpcdwrite_bytes(struct anx78xx *anx78xx, u8 addrh, + u8 addrm, u8 addrl, u8 count, u8 *buf) +{ + int i; + + sp_reg_write(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL1_REG, + ((count - 1) << SP_AUX_LENGTH_SHIFT) | 0x08); + sp_write_dpcd_addr(anx78xx, addrh, addrm, addrl); + for (i = 0; i < count && i < 16; i++) + sp_reg_write(anx78xx, TX_P0, SP_DP_BUF_DATA0_REG + i, buf[i]); + + sp_reg_set_bits(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL2_REG, SP_AUX_EN); + return sp_wait_aux_op_finish(anx78xx); +} + +static void sp_block_power_ctrl(struct anx78xx *anx78xx, + enum sp_tx_power_block sp_tx_pd_block, + bool power) +{ + if (power) + sp_reg_clear_bits(anx78xx, TX_P2, SP_POWERDOWN_CTRL_REG, + sp_tx_pd_block); + else + sp_reg_set_bits(anx78xx, TX_P2, SP_POWERDOWN_CTRL_REG, + sp_tx_pd_block); + + dev_dbg(&anx78xx->client->dev, + "sp_tx_power_on: %.2x\n", sp_tx_pd_block); +} + +static void sp_variable_init(void) +{ + sp.hdcp_enabled = false; + + sp.tx_system_state = STATE_WAITING_CABLE_PLUG; + + sp.read_edid_flag = false; + + memset(sp.edid_blocks, 0, sizeof(*sp.edid_blocks)); + + sp.tx_lt_state = LT_INIT; + sp.hdcp_state = HDCP_CAPABLE_CHECK; + sp.repeater_state = HDCP_DONE; + sp.tx_vo_state = VO_WAIT_VIDEO_STABLE; + sp.tx_ao_state = AO_INIT; + sp.changed_bandwidth = SP_LINK_5P4G; + + sp.hdcp_error_count = 0; + sp.hdcp_fail_count = 0; + sp.audio_stable_count = 0; + + sp.tx_test_lt = false; + sp.tx_test_bw = 0; + sp.tx_test_edid = false; +} + +static void sp_hdmi_tmds_phy_initialization(struct anx78xx *anx78xx) +{ + sp_reg_write(anx78xx, RX_P0, SP_TMDS_CTRL_BASE + 1, 0x90); + sp_reg_write(anx78xx, RX_P0, SP_TMDS_CTRL_BASE + 2, 0xa9); + sp_reg_write(anx78xx, RX_P0, SP_TMDS_CTRL_BASE + 6, 0x92); + sp_reg_write(anx78xx, RX_P0, SP_TMDS_CTRL_BASE + 7, 0x80); + sp_reg_write(anx78xx, RX_P0, SP_TMDS_CTRL_BASE + 20, 0xf2); +} + +static void sp_hdmi_initialization(struct anx78xx *anx78xx) +{ + sp_reg_write(anx78xx, RX_P0, SP_HDMI_MUTE_CTRL_REG, SP_AUD_MUTE | + SP_VID_MUTE); + sp_reg_set_bits(anx78xx, RX_P0, SP_CHIP_CTRL_REG, SP_MAN_HDMI5V_DET | + SP_PLLLOCK_CKDT_EN | SP_DIGITAL_CKDT_EN); + + sp_reg_set_bits(anx78xx, RX_P0, SP_SOFTWARE_RESET1_REG, + SP_HDCP_MAN_RST | SP_SW_MAN_RST | SP_TMDS_RST | + SP_VIDEO_RST); + sp_reg_clear_bits(anx78xx, RX_P0, SP_SOFTWARE_RESET1_REG, + SP_HDCP_MAN_RST | SP_SW_MAN_RST | SP_TMDS_RST | + SP_VIDEO_RST); + + /* Sync detect change, GP set mute */ + sp_reg_set_bits(anx78xx, RX_P0, SP_AUD_EXCEPTION_ENABLE_BASE + 1, + BIT(5) | BIT(6)); + sp_reg_set_bits(anx78xx, RX_P0, SP_AUD_EXCEPTION_ENABLE_BASE + 3, + SP_AEC_EN21); + sp_reg_set_bits(anx78xx, RX_P0, SP_AUDVID_CTRL_REG, SP_AVC_EN | + SP_AAC_OE | SP_AAC_EN); + + sp_reg_clear_bits(anx78xx, RX_P0, SP_SYSTEM_POWER_DOWN1_REG, + SP_PWDN_CTRL); + + sp_reg_set_bits(anx78xx, RX_P0, SP_VID_DATA_RANGE_CTRL_REG, + SP_R2Y_INPUT_LIMIT); + sp_reg_write(anx78xx, RX_P0, SP_TMDS_CTRL_BASE + 22, 0xc4); + sp_reg_write(anx78xx, RX_P0, SP_TMDS_CTRL_BASE + 23, 0x18); + + /* Enable DDC stretch */ + sp_reg_write(anx78xx, TX_P0, SP_DP_EXTRA_I2C_DEV_ADDR_REG, + SP_I2C_EXTRA_ADDR); + + sp_hdmi_tmds_phy_initialization(anx78xx); + sp_hdmi_set_hpd(anx78xx, false); + sp_hdmi_set_termination(anx78xx, false); +} + +static void sp_xtal_clk_sel(struct anx78xx *anx78xx) +{ + u8 val; + + sp_reg_update_bits(anx78xx, TX_P2, SP_ANALOG_DEBUG2_REG, + SP_XTAL_FRQ | SP_FORCE_SW_OFF_BYPASS, + SP_XTAL_FRQ_27M); + + sp_reg_write(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL3_REG, + XTAL_CLK & SP_WAIT_COUNTER_7_0_MASK); + sp_reg_write(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL4_REG, + ((XTAL_CLK & 0xff00) >> 2) | (XTAL_CLK / 10)); + + sp_reg_write(anx78xx, TX_P0, SP_I2C_GEN_10US_TIMER0_REG, + XTAL_CLK & 0xff); + sp_reg_write(anx78xx, TX_P0, SP_I2C_GEN_10US_TIMER1_REG, + (XTAL_CLK & 0xff00) >> 8); + sp_reg_write(anx78xx, TX_P0, SP_AUX_MISC_CTRL_REG, + XTAL_CLK / 10 - 1); + + sp_reg_read(anx78xx, RX_P0, SP_HDMI_US_TIMER_CTRL_REG, &val); + sp_reg_write(anx78xx, RX_P0, SP_HDMI_US_TIMER_CTRL_REG, + (val & SP_MS_TIMER_MARGIN_10_8_MASK) | + ((((XTAL_CLK / 10) >> 1) - 2) << 3)); +} + +void sp_tx_initialization(struct anx78xx *anx78xx) +{ + /* set terminal resistor to 50 ohm */ + sp_reg_write(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL2_REG, 0x30); + /* enable aux double diff output */ + sp_reg_set_bits(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL2_REG, 0x08); + + if (!sp_hdcp_repeater_mode(anx78xx)) { + sp_reg_clear_bits(anx78xx, TX_P0, SP_DP_HDCP_CTRL_REG, + SP_AUTO_EN | SP_AUTO_START); + sp_reg_write(anx78xx, TX_P0, SP_OTP_KEY_PROTECT1_REG, + SP_OTP_PSW1); + sp_reg_write(anx78xx, TX_P0, SP_OTP_KEY_PROTECT2_REG, + SP_OTP_PSW2); + sp_reg_write(anx78xx, TX_P0, SP_OTP_KEY_PROTECT3_REG, + SP_OTP_PSW3); + sp_reg_set_bits(anx78xx, TX_P0, SP_HDCP_KEY_COMMAND_REG, + SP_DISABLE_SYNC_HDCP); + } + + sp_reg_write(anx78xx, TX_P2, SP_VID_CTRL8_REG, SP_VID_VRES_TH); + + /* + * DP HDCP auto authentication wai timer (when downstream starts to + * auth, DP side will wait for this period then do auth automatically) + */ + sp_reg_write(anx78xx, TX_P0, SP_HDCP_AUTO_TIMER_REG, 0x00); + + sp_reg_set_bits(anx78xx, TX_P0, SP_DP_HDCP_CTRL_REG, SP_LINK_POLLING); + + sp_reg_set_bits(anx78xx, TX_P0, SP_DP_LINK_DEBUG_CTRL_REG, + SP_M_VID_DEBUG); + sp_reg_set_bits(anx78xx, TX_P2, SP_ANALOG_DEBUG2_REG, + SP_POWERON_TIME_1P5MS); + + sp_xtal_clk_sel(anx78xx); + sp_reg_write(anx78xx, TX_P0, SP_AUX_DEFER_CTRL_REG, + SP_DEFER_CTRL_EN | 0x0c); + + sp_reg_set_bits(anx78xx, TX_P0, SP_DP_POLLING_CTRL_REG, + SP_AUTO_POLLING_DISABLE); + /* + * Short the link integrity check timer to speed up bstatus + * polling for HDCP CTS item 1A-07 + */ + sp_reg_write(anx78xx, TX_P0, SP_HDCP_LINK_CHECK_TIMER_REG, 0x1d); + sp_reg_set_bits(anx78xx, TX_P0, SP_DP_MISC_CTRL_REG, + SP_EQ_TRAINING_LOOP); + + /* power down the main link by default */ + sp_reg_set_bits(anx78xx, TX_P0, SP_DP_ANALOG_POWER_DOWN_REG, + SP_CH0_PD); + + sp_reg_write(anx78xx, TX_P2, SP_INT_CTRL_REG, 0x01); + + sp_link_phy_initialization(anx78xx); + sp_gen_m_clk_with_downspreading(anx78xx); + + sp.down_sample_en = false; +} + +/* + * Check if it is ANALOGIX dongle. + */ +static const u8 anx_oui[3] = {0x00, 0x22, 0xb9}; + +static bool is_anx_dongle(struct anx78xx *anx78xx) +{ + u8 buf[3]; + + /* DPCD 400 show ANX-dongle */ + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x04, 0x00, 3, buf); + if (!memcmp(buf, anx_oui, 3)) + return true; + + /* 0x0500~0x0502: BRANCH_IEEE_OUI */ + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x05, 0x00, 3, buf); + if (!memcmp(buf, anx_oui, 3)) + return true; + + return false; +} + +static const u8 anx7750[4] = {0x37, 0x37, 0x35, 0x30}; + +static u8 sp_get_rx_bw(struct anx78xx *anx78xx) +{ + u8 bandwidth, max_link_rate; + u8 buf[4]; + + bandwidth = 0; + /* + * When ANX dongle is connected, if CHIP_ID=0x7750 the bandwidth is + * 6.75G because ANX7750 DPCD 0x052x is not available. + */ + if (is_anx_dongle(anx78xx)) { + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x05, 0x03, 4, buf); + if (!memcmp(buf, anx7750, sizeof(anx7750))) + bandwidth = SP_LINK_6P75G; + else + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x05, 0x21, + 1, &bandwidth); + } + + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x00, SP_DPCD_MAX_LINK_RATE, + 1, &max_link_rate); + if (bandwidth < max_link_rate) + bandwidth = max_link_rate; + + return bandwidth; +} + +static bool sp_get_dp_connection(struct anx78xx *anx78xx) +{ + u8 val; + + if (sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x02, SP_DPCD_SINK_COUNT, 1, + &val)) + return false; + + if (!(val & 0x1f)) + return false; + + if (sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x00, 0x04, 1, &val)) + return false; + + if (val & 0x20) { + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x06, 0x00, 1, &val); + /* + * Bit 5 = SET_DN_DEVICE_DP_PWR_5V + * Bit 6 = SET_DN_DEVICE_DP_PWR_12V + * Bit 7 = SET_DN_DEVICE_DP_PWR_18V + */ + val &= 0x1f; + val |= 0x20; + sp_aux_dpcdwrite_bytes(anx78xx, 0x00, 0x06, 0x00, 1, &val); + } + + return true; +} + +/******************start EDID process********************/ +static void sp_enable_video_input(struct anx78xx *anx78xx, bool enable) +{ + struct device *dev = &anx78xx->client->dev; + u8 val; + + sp_reg_read(anx78xx, TX_P2, SP_VID_CTRL1_REG, &val); + if (enable) { + sp_reg_set_bits(anx78xx, TX_P2, SP_VID_CTRL1_REG, SP_VIDEO_EN); + dev_dbg(dev, "Slimport video is enabled!\n"); + } else { + sp_reg_clear_bits(anx78xx, TX_P2, SP_VID_CTRL1_REG, + SP_VIDEO_EN); + dev_dbg(dev, "Slimport video is disabled!\n"); + } +} + +static u8 sp_get_edid_bandwidth(u8 *data) +{ + u16 pclk; + + pclk = ((u16)data[1] << 8) | ((u16)data[0] & 0xff); + if (pclk <= 5300) + return SP_LINK_1P62G; + else if (pclk <= 8900) + return SP_LINK_2P7G; + else if (pclk <= 18000) + return SP_LINK_5P4G; + else + return SP_LINK_6P75G; +} + +static u8 sp_parse_edid_to_get_bandwidth(struct anx78xx *anx78xx) +{ + int i; + u8 bandwidth, temp; + + bandwidth = SP_LINK_1P62G; + for (i = 0; i < 4; i++) { + if (sp.edid_blocks[0x36 + 0x12 * i] == 0) + break; + temp = sp_get_edid_bandwidth(sp.edid_blocks + 0x36 + 0x12 * i); + dev_dbg(&anx78xx->client->dev, "bandwidth via EDID : %x\n", + temp); + if (bandwidth < temp) + bandwidth = temp; + if (bandwidth >= SP_LINK_6P75G) + break; + } + + return bandwidth; +} + +u8 sp_get_link_bandwidth(struct anx78xx *anx78xx) +{ + u8 bandwidth, max_bandwidth; + + bandwidth = sp_get_rx_bw(anx78xx); + max_bandwidth = sp_parse_edid_to_get_bandwidth(anx78xx); + if (bandwidth > max_bandwidth) + return max_bandwidth; + + return bandwidth; +} + +static int sp_tx_aux_wr(struct anx78xx *anx78xx, u8 offset) +{ + sp_reg_write(anx78xx, TX_P0, SP_DP_BUF_DATA0_REG, offset); + sp_reg_write(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL1_REG, 0x04); + sp_reg_set_bits(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL2_REG, SP_AUX_EN); + + return sp_wait_aux_op_finish(anx78xx); +} + +static int sp_tx_aux_rd(struct anx78xx *anx78xx, u8 len) +{ + sp_reg_write(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL1_REG, len); + sp_reg_set_bits(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL2_REG, SP_AUX_EN); + + return sp_wait_aux_op_finish(anx78xx); +} + +static u8 sp_tx_get_edid_block(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + u8 val; + + sp_tx_aux_wr(anx78xx, 0x7e); + sp_tx_aux_rd(anx78xx, 0x01); + sp_reg_read(anx78xx, TX_P0, SP_DP_BUF_DATA0_REG, &val); + dev_dbg(dev, "EDID Block = %d\n", val + 1); + + if (val > 3) + val = 1; + return val; +} + +static int sp_edid_read(struct anx78xx *anx78xx, u8 offset, + u8 *buf) +{ + u8 data_cnt, errcnt; + u8 val, ret; + + sp_tx_aux_wr(anx78xx, offset); + sp_tx_aux_rd(anx78xx, 0xf5); + data_cnt = 0; + errcnt = 0; + + while (data_cnt < 16) { + sp_reg_read(anx78xx, TX_P0, SP_BUF_DATA_COUNT_REG, &val); + + if (val & 0x1f) { + data_cnt = data_cnt + (val & 0x1f); + do { + sp_reg_read(anx78xx, TX_P0, + SP_DP_BUF_DATA0_REG + val - 1, + &buf[val - 1]); + } while (--val); + } else { + if (errcnt++ <= 2) { + sp_reset_aux(anx78xx); + val = 0x05 | ((0x0f - data_cnt) << 4); + sp_tx_aux_rd(anx78xx, val); + } else { + return -1; + } + } + } + sp_reg_write(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL1_REG, 0x01); + sp_reg_set_bits(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL2_REG, + SP_ADDR_ONLY | SP_AUX_EN); + ret = sp_wait_aux_op_finish(anx78xx); + sp_addronly_set(anx78xx, false); + + return ret; +} + +static void sp_tx_edid_read_initial(struct anx78xx *anx78xx) +{ + sp_reg_write(anx78xx, TX_P0, SP_AUX_ADDR_7_0_REG, 0x50); + sp_reg_write(anx78xx, TX_P0, SP_AUX_ADDR_15_8_REG, 0); + sp_reg_clear_bits(anx78xx, TX_P0, SP_AUX_ADDR_19_16_REG, 0xf0); +} + +static int sp_seg_edid_read(struct anx78xx *anx78xx, + u8 segment, u8 offset) +{ + struct device *dev = &anx78xx->client->dev; + u8 val, errcnt; + int i; + + sp_reg_write(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL1_REG, 0x04); + sp_reg_write(anx78xx, TX_P0, SP_AUX_ADDR_7_0_REG, 0x30); + + sp_reg_set_bits(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL2_REG, + SP_ADDR_ONLY | SP_AUX_EN); + + if (sp_wait_aux_op_finish(anx78xx)) + return -1; + + sp_reg_write(anx78xx, TX_P0, SP_DP_BUF_DATA0_REG, segment); + sp_reg_write(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL1_REG, 0x04); + + sp_reg_update_bits(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL2_REG, + SP_ADDR_ONLY | SP_AUX_EN, SP_AUX_EN); + + errcnt = 10; + while (errcnt--) { + sp_reg_read(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL2_REG, &val); + if (!(val & SP_AUX_EN)) + break; + usleep_range(1000, 2000); + } + + if (!errcnt) { + dev_err(dev, "read SP_DP_AUX_CH_CTRL2_REG failed.\n"); + sp_reset_aux(anx78xx); + return -1; + } + + sp_reg_write(anx78xx, TX_P0, SP_AUX_ADDR_7_0_REG, 0x50); + sp_tx_aux_wr(anx78xx, offset); + sp_tx_aux_rd(anx78xx, 0xf5); + + for (i = 0; i < 16; i++) { + errcnt = 10; + while (errcnt--) { + sp_reg_read(anx78xx, TX_P0, SP_BUF_DATA_COUNT_REG, + &val); + if (val & 0x1f) + break; + usleep_range(2000, 4000); + } + + if (!errcnt) { + dev_err(dev, "read SP_BUF_DATA_COUNT_REG failed.\n"); + sp_reset_aux(anx78xx); + return -1; + } + + sp_reg_read(anx78xx, TX_P0, SP_DP_BUF_DATA0_REG + i, &val); + } + + sp_reg_write(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL1_REG, 0x01); + sp_reg_set_bits(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL2_REG, + SP_ADDR_ONLY | SP_AUX_EN); + sp_reg_clear_bits(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL2_REG, + SP_ADDR_ONLY); + sp_reg_read(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL2_REG, &val); + + errcnt = 10; + while (errcnt--) { + sp_reg_read(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL2_REG, &val); + if (!(val & SP_AUX_EN)) + break; + usleep_range(1000, 2000); + } + + if (!errcnt) { + dev_err(dev, "read SP_DP_AUX_CH_CTRL2_REG failed.\n"); + sp_reset_aux(anx78xx); + return -1; + } + + return 0; +} + +static int sp_edid_block_checksum(const u8 *raw_edid) +{ + int i; + u8 csum = 0; + + for (i = 0; i < EDID_LENGTH; i++) + csum += raw_edid[i]; + + return csum; +} + +static int sp_tx_edid_read(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + u8 val, blocks, offset = 0; + u8 buf[16]; + int i, j, count; + + sp_tx_edid_read_initial(anx78xx); + sp_reg_write(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL1_REG, 0x04); + sp_reg_set_bits(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL2_REG, 0x03); + + if (sp_wait_aux_op_finish(anx78xx)) + return -1; + + sp_addronly_set(anx78xx, false); + + blocks = sp_tx_get_edid_block(anx78xx); + /* for every block */ + for (count = 0; count < blocks; count++) { + switch (count) { + case 0: + case 1: + for (i = 0; i < 8; i++) { + offset = (i + count * 8) * 16; + if (sp_edid_read(anx78xx, offset, buf)) + return -1; + for (j = 0; j < 16; j++) + sp.edid_blocks[offset + j] = buf[j]; + } + break; + case 2: + case 3: + offset = (count == 2) ? 0x00 : 0x80; + for (j = 0; j < 8; j++) { + if (sp_seg_edid_read(anx78xx, count / 2, + offset)) + return -1; + offset = offset + 0x10; + } + break; + default: + break; + } + } + + sp_reset_aux(anx78xx); + + if (!drm_edid_block_valid(sp.edid_blocks, 0, true, NULL)) { + dev_err(dev, "EDID block is invalid\n"); + return -1; + } + + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x02, 0x18, 1, &val); + if (val & 0x04) { + val = sp_edid_block_checksum(sp.edid_blocks); + dev_dbg(dev, "EDID checksum is %d\n", val); + sp_aux_dpcdwrite_bytes(anx78xx, 0x00, 0x02, 0x61, 1, &val); + sp.tx_test_edid = true; + val = 0x04; + sp_aux_dpcdwrite_bytes(anx78xx, 0x00, 0x02, 0x60, 1, &val); + dev_dbg(dev, "test EDID done\n"); + } + + return 0; +} + +static bool sp_check_with_pre_edid(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + u8 i; + u8 buf[16]; + bool ret = false; + + sp_tx_edid_read_initial(anx78xx); + sp_reg_write(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL1_REG, 0x04); + sp_reg_set_bits(anx78xx, TX_P0, SP_DP_AUX_CH_CTRL2_REG, 0x03); + + if (sp_wait_aux_op_finish(anx78xx)) + goto return_point; + + sp_addronly_set(anx78xx, false); + + if (sp_edid_read(anx78xx, 0x70, buf)) + goto return_point; + + for (i = 0; i < 16; i++) { + if (sp.edid_blocks[0x70 + i] != buf[i]) { + dev_dbg(dev, "%s\n", + "different checksum and blocks num\n"); + goto return_point; + } + } + + if (sp_edid_read(anx78xx, 0x08, buf)) + goto return_point; + + for (i = 0; i < 16; i++) { + if (sp.edid_blocks[i + 8] != buf[i]) { + dev_dbg(dev, "different edid information\n"); + goto return_point; + } + } + + ret = true; +return_point: + sp_reset_aux(anx78xx); + + return ret; +} + +static bool sp_edid_process(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + u8 bw, edid_bw, val; + int i; + + if (sp.read_edid_flag) { + if (!sp_check_with_pre_edid(anx78xx)) + sp.read_edid_flag = false; + } else { + if (sp_tx_edid_read(anx78xx)) { + dev_err(dev, "EDID corruption!\n"); + return false; + } + } + + /* Release the HPD after the OTP loaddown */ + for (i = 0; i < 10; i++) { + sp_reg_read(anx78xx, TX_P0, SP_HDCP_KEY_STATUS_REG, &val); + if (val & 0x01) + break; + + dev_dbg(dev, "waiting HDCP KEY loaddown\n"); + usleep_range(1000, 2000); + } + + sp_reg_write(anx78xx, RX_P0, SP_INT_MASK_BASE + 1, + SP_HDMI_DVI | SP_CKDT_CHG | SP_SCDT_CHG | + SP_CABLE_PLUG_CHG); + + if (!sp_hdcp_repeater_mode(anx78xx)) { + sp_hdmi_set_hpd(anx78xx, true); + sp_hdmi_set_termination(anx78xx, true); + } + + bw = sp_get_rx_bw(anx78xx); + dev_dbg(dev, "RX BW %x\n", bw); + + edid_bw = sp_parse_edid_to_get_bandwidth(anx78xx); + if (bw <= edid_bw) + edid_bw = bw; + + dev_dbg(dev, "set link bw in edid %x\n", edid_bw); + sp.changed_bandwidth = edid_bw; + + return true; +} + +/******************End EDID process********************/ + +/******************start Link training process********************/ +static void sp_lvttl_bit_mapping(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + u8 val, colorspace; + u8 vid_bit; + + vid_bit = 0; + sp_reg_read(anx78xx, RX_P1, SP_AVI_INFOFRAME_DATA_BASE, &colorspace); + colorspace &= SP_AVI_COLOR_F_MASK; + colorspace >>= SP_AVI_COLOR_F_SHIFT; + + sp_reg_read(anx78xx, RX_P0, SP_VIDEO_STATUS_REG, &val); + switch ((val & SP_COLOR_DEPTH_MASK) >> SP_COLOR_DEPTH_SHIFT) { + default: + case HDMI_LEGACY: + val = SP_IN_BPC_8BIT; + vid_bit = 0; + break; + case HDMI_24BIT: + val = SP_IN_BPC_8BIT; + if (colorspace == SP_COLORSPACE_YCBCR422) + vid_bit = 5; + else + vid_bit = 1; + break; + case HDMI_30BIT: + val = SP_IN_BPC_10BIT; + if (colorspace == SP_COLORSPACE_YCBCR422) + vid_bit = 6; + else + vid_bit = 2; + /* + * For 10bit video must be set this value to 12bit by + * someone + */ + if (sp.down_sample_en) + vid_bit = 3; + break; + case HDMI_36BIT: + val = SP_IN_BPC_12BIT; + if (colorspace == SP_COLORSPACE_YCBCR422) + vid_bit = 6; + else + vid_bit = 3; + break; + } + + /* + * For down sample video (12bit, 10bit ---> 8bit), + * this register doesn't change + */ + if (!sp.down_sample_en) + sp_reg_update_bits(anx78xx, TX_P2, SP_VID_CTRL2_REG, + SP_IN_BPC_MASK | SP_IN_COLOR_F_MASK, + (val << SP_IN_BPC_SHIFT) | colorspace); + + sp_reg_write(anx78xx, TX_P2, SP_BIT_CTRL_SPECIFIC_REG, + SP_ENABLE_BIT_CTRL | vid_bit << SP_BIT_CTRL_SELECT_SHIFT); + + if (sp.tx_test_edid) { + /* Set color depth to 6 bpc (18 bpp) for link cts */ + sp_reg_update_bits(anx78xx, TX_P2, SP_VID_CTRL2_REG, + SP_IN_BPC_MASK, SP_IN_BPC_6BIT); + sp.tx_test_edid = false; + dev_dbg(dev, "color space is set to 6 bpc (18 bpp)\n"); + } + + if (colorspace) { + /* + * Set video values to default of channel 0, 1 and 2 for HDCP + * embedded "blue screen" when HDCP authentication failed. + */ + sp_reg_write(anx78xx, TX_P0, SP_HDCP_VID0_BLUE_SCREEN_REG, + 0x80); + sp_reg_write(anx78xx, TX_P0, SP_HDCP_VID1_BLUE_SCREEN_REG, + 0x00); + sp_reg_write(anx78xx, TX_P0, SP_HDCP_VID2_BLUE_SCREEN_REG, + 0x80); + } else { + sp_reg_write(anx78xx, TX_P0, SP_HDCP_VID0_BLUE_SCREEN_REG, + 0x00); + sp_reg_write(anx78xx, TX_P0, SP_HDCP_VID0_BLUE_SCREEN_REG, + 0x00); + sp_reg_write(anx78xx, TX_P0, SP_HDCP_VID0_BLUE_SCREEN_REG, + 0x00); + } +} + +static unsigned long sp_pclk_calc(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + unsigned long str_plck; + u16 vid_counter; + u8 val; + + sp_reg_read(anx78xx, RX_P0, SP_PCLK_HIGHRES_CNT_BASE + 2, &val); + vid_counter = val << 8; + sp_reg_read(anx78xx, RX_P0, SP_PCLK_HIGHRES_CNT_BASE + 1, &val); + vid_counter |= val; + str_plck = (vid_counter * XTAL_CLK) >> 12; + dev_dbg(dev, "pixel clock is %ld.%ld\n", str_plck / 10, str_plck % 10); + return str_plck; +} + +static u8 sp_tx_bw_lc_sel(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + unsigned long pixel_clk; + u8 link, val; + + pixel_clk = sp_pclk_calc(anx78xx); + + sp_reg_read(anx78xx, RX_P0, SP_VIDEO_STATUS_REG, &val); + switch ((val & SP_COLOR_DEPTH_MASK) >> SP_COLOR_DEPTH_SHIFT) { + case HDMI_LEGACY: + case HDMI_24BIT: + default: + break; + case HDMI_30BIT: + pixel_clk = (pixel_clk * 5) >> 2; + break; + case HDMI_36BIT: + pixel_clk = (pixel_clk * 3) >> 1; + break; + } + + dev_dbg(dev, "pixel clock is %ld.%ld\n", pixel_clk / 10, + pixel_clk % 10); + + sp.down_sample_en = false; + if (pixel_clk <= 530) { + link = SP_LINK_1P62G; + } else if (pixel_clk <= 890) { + link = SP_LINK_2P7G; + } else if (pixel_clk <= 1800) { + link = SP_LINK_5P4G; + } else { + link = SP_LINK_6P75G; + if (pixel_clk > 2240) + sp.down_sample_en = true; + } + + if (sp_get_link_bw(anx78xx) != link) { + sp.changed_bandwidth = link; + dev_dbg(dev, + "different bandwidth between sink and video %.2x", + link); + return -1; + } + return 0; +} + +static void sp_downspeading_enable(struct anx78xx *anx78xx, bool enable) +{ + u8 val; + + sp_reg_read(anx78xx, TX_P0, SP_DP_DOWNSPREADING_CTRL1_REG, &val); + + if (enable) { + val |= SP_TX_SSC_DOWNSPREADING; + sp_reg_write(anx78xx, TX_P0, SP_DP_DOWNSPREADING_CTRL1_REG, + val); + + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x01, + SP_DPCD_DOWNSPREADING_CTRL, 1, &val); + val |= SP_SPREAD_AMPLITUDE; + sp_aux_dpcdwrite_bytes(anx78xx, 0x00, 0x01, + SP_DPCD_DOWNSPREADING_CTRL, 1, &val); + } else { + val &= ~SP_TX_SSC_DISABLE; + sp_reg_write(anx78xx, TX_P0, SP_DP_DOWNSPREADING_CTRL1_REG, + val); + + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x01, + SP_DPCD_DOWNSPREADING_CTRL, 1, &val); + val &= ~SP_SPREAD_AMPLITUDE; + sp_aux_dpcdwrite_bytes(anx78xx, 0x00, 0x01, + SP_DPCD_DOWNSPREADING_CTRL, 1, &val); + } +} + +static void sp_config_ssc(struct anx78xx *anx78xx, + enum sp_ssc_dep sscdep) +{ + sp_reg_write(anx78xx, TX_P0, SP_DP_DOWNSPREADING_CTRL1_REG, 0x0); + sp_reg_write(anx78xx, TX_P0, SP_DP_DOWNSPREADING_CTRL1_REG, sscdep); + sp_downspeading_enable(anx78xx, true); +} + +static void sp_enhancemode_set(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + u8 val; + + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x00, SP_DPCD_MAX_LANE_COUNT, 1, + &val); + + if (val & SP_ENHANCED_FRAME_CAP) { + sp_reg_set_bits(anx78xx, TX_P0, SP_DP_SYSTEM_CTRL_BASE + 4, + SP_ENHANCED_MODE); + + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x01, + SP_DPCD_LANE_COUNT_SET, 1, &val); + val |= SP_ENHANCED_FRAME_EN; + sp_aux_dpcdwrite_bytes(anx78xx, 0x00, 0x01, + SP_DPCD_LANE_COUNT_SET, 1, &val); + + dev_dbg(dev, "enhance mode enabled\n"); + } else { + sp_reg_clear_bits(anx78xx, TX_P0, SP_DP_SYSTEM_CTRL_BASE + 4, + SP_ENHANCED_MODE); + + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x01, + SP_DPCD_LANE_COUNT_SET, 1, &val); + + val &= ~SP_ENHANCED_FRAME_EN; + sp_aux_dpcdwrite_bytes(anx78xx, 0x00, 0x01, + SP_DPCD_LANE_COUNT_SET, 1, &val); + + dev_dbg(dev, "enhance mode disabled\n"); + } +} + +static u16 sp_link_err_check(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + u16 err; + u8 buf[2]; + + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x02, 0x10, 2, buf); + usleep_range(5000, 10000); + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x02, 0x10, 2, buf); + + if (buf[1] & 0x80) { + err = ((buf[1] & 0x7f) << 8) + buf[0]; + dev_err(dev, "error of Lane %d\n", err); + return err; + } + + return 0; +} + +static bool sp_lt_finish(struct anx78xx *anx78xx) +{ + u8 val; + struct device *dev = &anx78xx->client->dev; + + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x02, 0x02, 1, &val); + + if ((val & 0x07) != 0x07) { + dev_dbg(dev, "Lane0 status error %.2x\n", val & 0x07); + sp.tx_lt_state = LT_ERROR; + return false; + } + + /* + * If there is link error, adjust pre-emphasis to check error + * again. If there is no error, keep the setting, otherwise + * use 400mv0db + */ + if (sp.tx_test_lt) { + sp.tx_test_lt = false; + sp.tx_lt_state = LT_INIT; + return true; + } + + if (sp_link_err_check(anx78xx)) { + sp_reg_read(anx78xx, TX_P0, SP_DP_LANE0_LT_CTRL_REG, &val); + if (!(val & SP_MAX_PRE_REACH)) { + /* Increase one pre-level */ + sp_reg_write(anx78xx, TX_P0, SP_DP_LANE0_LT_CTRL_REG, + val + 0x08); + /* + * If error still exists, return to the link training + * value + */ + if (sp_link_err_check(anx78xx)) + sp_reg_write(anx78xx, TX_P0, + SP_DP_LANE0_LT_CTRL_REG, val); + } + } + + val = sp_get_link_bw(anx78xx); + if (val != sp.changed_bandwidth) { + dev_dbg(dev, "bandwidth changed, cur:%.2x, per:%.2x\n", val, + sp.changed_bandwidth); + sp.tx_lt_state = LT_ERROR; + return false; + } + + dev_dbg(dev, "LT succeed, bandwidth: %.2x", val); + sp_reg_read(anx78xx, TX_P0, SP_DP_LANE0_LT_CTRL_REG, &val); + dev_dbg(dev, "Lane0 set to %.2x\n", val); + sp.tx_lt_state = LT_INIT; + + if (sp_hdcp_repeater_mode(anx78xx)) { + dev_dbg(dev, "HPD set to 1!\n"); + sp_hdmi_set_hpd(anx78xx, true); + sp_hdmi_set_termination(anx78xx, true); + } + + /* + * Under low voltage (DVD10 = 0.97V), some chips cannot output video, + * link down interrupt always happens. + */ + if (sp_link_err_check(anx78xx) > 200) { + dev_dbg(dev, "need to reset Serdes FIFO"); + sp.tx_lt_state = LT_ERROR; + } else { + return true; + } + + return false; +} + +static bool sp_link_training(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + u8 val, version; + + switch (sp.tx_lt_state) { + case LT_INIT: + sp_block_power_ctrl(anx78xx, SP_TX_PWR_VIDEO, 1); + sp_video_mute(anx78xx, true); + sp_enable_video_input(anx78xx, false); + sp.tx_lt_state = LT_WAIT_PLL_LOCK; + /* fallthrough */ + case LT_WAIT_PLL_LOCK: + if (!sp_get_pll_lock_status(anx78xx)) { + sp_reg_read(anx78xx, TX_P0, SP_DP_PLL_CTRL_REG, + &val); + + val |= SP_PLL_RST; + sp_reg_write(anx78xx, TX_P0, SP_DP_PLL_CTRL_REG, + val); + + val &= ~SP_PLL_RST; + sp_reg_write(anx78xx, TX_P0, SP_DP_PLL_CTRL_REG, + val); + + dev_dbg(dev, "PLL not lock!\n"); + break; + } else { + sp.tx_lt_state = LT_CHECK_LINK_BW; + } + /* fallthrough */ + case LT_CHECK_LINK_BW: + val = sp_get_rx_bw(anx78xx); + if (val < sp.changed_bandwidth) { + dev_dbg(dev, "over bandwidth!\n"); + sp.changed_bandwidth = val; + break; + } else { + sp.tx_lt_state = LT_START; + } + /* fallthrough */ + case LT_START: + if (sp.tx_test_lt) { + sp.changed_bandwidth = sp.tx_test_bw; + sp_reg_clear_bits(anx78xx, TX_P2, SP_VID_CTRL2_REG, + 0x70); + } else { + sp_reg_write(anx78xx, TX_P0, SP_DP_LANE0_LT_CTRL_REG, + 0x00); + } + + sp_reg_clear_bits(anx78xx, TX_P0, SP_DP_ANALOG_POWER_DOWN_REG, + SP_CH0_PD); + + sp_config_ssc(anx78xx, SSC_DEP_4000PPM); + sp_set_link_bw(anx78xx, sp.changed_bandwidth); + sp_enhancemode_set(anx78xx); + + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x00, 0x00, 1, + &version); + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x06, 0x00, 1, + &val); + if (version >= 0x12) + val &= 0xf8; + else + val &= 0xfc; + val |= 0x01; + sp_aux_dpcdwrite_bytes(anx78xx, 0x00, 0x06, 0x00, 1, + &val); + + sp_reg_write(anx78xx, TX_P0, SP_DP_LT_CTRL_REG, SP_LT_EN); + sp.tx_lt_state = LT_WAITING_FINISH; + /* fallthrough */ + case LT_WAITING_FINISH: + /* Waiting interrupt to change training state. */ + break; + case LT_ERROR: + sp_reg_set_bits(anx78xx, TX_P2, SP_RESET_CTRL2_REG, + SP_SERDES_FIFO_RST); + msleep(20); + sp_reg_clear_bits(anx78xx, TX_P2, SP_RESET_CTRL2_REG, + SP_SERDES_FIFO_RST); + dev_err(dev, "LT ERROR reset SERDES FIFO"); + sp.tx_lt_state = LT_INIT; + break; + case LT_FINISH: + if (sp_lt_finish(anx78xx)) + return true; + break; + default: + break; + } + + return false; +} + +/******************End Link training process********************/ + +/******************Start Output video process********************/ +static bool sp_match_vic_for_bt709(u8 vic) +{ + /* Video Identification Code (VIC) for BT709 */ + return ((vic == 0x04) || (vic == 0x05) || (vic == 0x10) || + (vic == 0x13) || (vic == 0x14) || (vic == 0x1f) || + (vic == 0x20) || (vic == 0x21) || (vic == 0x22) || + (vic == 0x27) || (vic == 0x28) || (vic == 0x29) || + (vic == 0x2e) || (vic == 0x2f) || (vic == 0x3c) || + (vic == 0x3d) || (vic == 0x3e) || (vic == 0x3f) || + (vic == 0x40)); +} + +static void sp_set_colorspace(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + u8 colorspace, val; + + if (sp.down_sample_en) { + sp_reg_read(anx78xx, RX_P1, SP_AVI_INFOFRAME_DATA_BASE, + &colorspace); + colorspace &= SP_AVI_COLOR_F_MASK; + colorspace >>= SP_AVI_COLOR_F_SHIFT; + if (colorspace == SP_COLORSPACE_YCBCR422) { + dev_dbg(dev, "YCbCr4:2:2 ---> PASS THROUGH.\n"); + sp_reg_write(anx78xx, TX_P2, SP_VID_CTRL6_REG, 0x00); + sp_reg_write(anx78xx, TX_P2, SP_VID_CTRL5_REG, 0x00); + } else if (colorspace == SP_COLORSPACE_YCBCR444) { + dev_dbg(dev, "YCbCr4:4:4 ---> YCbCr4:2:2\n"); + sp_reg_write(anx78xx, TX_P2, SP_VID_CTRL6_REG, + SP_VIDEO_PROCESS_EN | SP_UP_SAMPLE); + sp_reg_write(anx78xx, TX_P2, SP_VID_CTRL5_REG, 0x00); + } else if (colorspace == SP_COLORSPACE_RGB) { + dev_dbg(dev, "RGB4:4:4 ---> YCbCr4:2:2\n"); + sp_reg_write(anx78xx, TX_P2, SP_VID_CTRL6_REG, + SP_VIDEO_PROCESS_EN | SP_UP_SAMPLE); + sp_reg_write(anx78xx, TX_P2, SP_VID_CTRL5_REG, + SP_CSC_STD_SEL | SP_RANGE_R2Y | + SP_CSPACE_R2Y); + } + sp_reg_write(anx78xx, TX_P2, SP_VID_CTRL2_REG, + (SP_IN_BPC_8BIT << SP_IN_BPC_SHIFT) | colorspace); + } else { + sp_reg_read(anx78xx, TX_P2, SP_VID_CTRL2_REG, &colorspace); + colorspace &= SP_IN_COLOR_F_MASK; + + /* + * To change the CSC_STD_SEL bit we need to set + * CSPACE_Y2R and CSPACE_ R2Y, otherwise has no + * effect or is undetermined. + */ + if (colorspace == SP_COLORSPACE_RGB) { + sp_reg_clear_bits(anx78xx, TX_P2, SP_VID_CTRL5_REG, + SP_RANGE_Y2R | SP_CSPACE_Y2R | + SP_CSC_STD_SEL); + sp_reg_clear_bits(anx78xx, TX_P2, SP_VID_CTRL6_REG, + SP_VIDEO_PROCESS_EN | SP_UP_SAMPLE); + } else { + /* + * Colorimetric format of input video is YCbCr422 + * or YCbCr444 + */ + sp_reg_set_bits(anx78xx, TX_P2, SP_VID_CTRL5_REG, + SP_RANGE_Y2R | SP_CSPACE_Y2R); + + sp_reg_read(anx78xx, RX_P1, + SP_AVI_INFOFRAME_DATA_BASE + 3, + &val); + + if (sp_match_vic_for_bt709(val)) + sp_reg_set_bits(anx78xx, TX_P2, + SP_VID_CTRL5_REG, + SP_CSC_STD_SEL); + else /* Convert based on BT601 */ + sp_reg_clear_bits(anx78xx, TX_P2, + SP_VID_CTRL5_REG, + SP_CSC_STD_SEL); + /* + * Enable 4:2:2 to 4:4:4 up sample when is required + * and enable video process function. + */ + if (colorspace == SP_COLORSPACE_YCBCR422) + sp_reg_set_bits(anx78xx, TX_P2, + SP_VID_CTRL6_REG, + SP_VIDEO_PROCESS_EN | + SP_UP_SAMPLE); + else /* YCBCR444 */ + sp_reg_update_bits(anx78xx, TX_P2, + SP_VID_CTRL6_REG, + SP_VIDEO_PROCESS_EN | + SP_UP_SAMPLE, + SP_VIDEO_PROCESS_EN); + } + } +} + +static void sp_packet_avi_init(struct anx78xx *anx78xx) +{ + u8 val; + int i; + + sp.tx_packet_avi.infoframe.type = HDMI_INFOFRAME_TYPE_AVI; + sp.tx_packet_avi.infoframe.version = 2; + sp.tx_packet_avi.infoframe.length = HDMI_AVI_INFOFRAME_SIZE; + + for (i = 0; i < sp.tx_packet_avi.infoframe.length; i++) { + sp_reg_read(anx78xx, RX_P1, SP_AVI_INFOFRAME_DATA_BASE + i, + &val); + sp.tx_packet_avi.data[i] = val; + } + + sp.tx_packet_avi.data[0] &= ~SP_AVI_COLOR_F_MASK; +} + +static void sp_load_packet(struct anx78xx *anx78xx, enum packets_type type) +{ + int i; + + switch (type) { + case AVI_PACKETS: + sp_reg_write(anx78xx, TX_P2, SP_INFOFRAME_AVI_TYPE_REG, + sp.tx_packet_avi.infoframe.type); + sp_reg_write(anx78xx, TX_P2, SP_INFOFRAME_AVI_VER_REG, + sp.tx_packet_avi.infoframe.version); + sp_reg_write(anx78xx, TX_P2, SP_INFOFRAME_AVI_LEN_REG, + sp.tx_packet_avi.infoframe.length); + + for (i = 0; i < sp.tx_packet_avi.infoframe.length; i++) { + sp_reg_write(anx78xx, TX_P2, + SP_INFOFRAME_AVI_DB0_REG + i, + sp.tx_packet_avi.data[i]); + } + + break; + case VSI_PACKETS: + sp_reg_write(anx78xx, TX_P2, SP_INFOFRAME_MPEG_TYPE_REG, + sp.tx_packet_vsi.infoframe.type); + sp_reg_write(anx78xx, TX_P2, SP_INFOFRAME_MPEG_VER_REG, + sp.tx_packet_vsi.infoframe.version); + sp_reg_write(anx78xx, TX_P2, SP_INFOFRAME_MPEG_LEN_REG, + sp.tx_packet_vsi.infoframe.length); + + for (i = 0; i < sp.tx_packet_vsi.infoframe.length; i++) { + sp_reg_write(anx78xx, TX_P2, + SP_INFOFRAME_MPEG_DB0_REG + i, + sp.tx_packet_vsi.data[i]); + } + break; + case MPEG_PACKETS: + sp_reg_write(anx78xx, TX_P2, SP_INFOFRAME_MPEG_TYPE_REG, + sp.tx_packet_mpeg.infoframe.type); + sp_reg_write(anx78xx, TX_P2, SP_INFOFRAME_MPEG_VER_REG, + sp.tx_packet_mpeg.infoframe.version); + sp_reg_write(anx78xx, TX_P2, SP_INFOFRAME_MPEG_LEN_REG, + sp.tx_packet_mpeg.infoframe.length); + + for (i = 0; i < sp.tx_packet_mpeg.infoframe.length; i++) { + sp_reg_write(anx78xx, TX_P2, + SP_INFOFRAME_MPEG_DB0_REG + i, + sp.tx_packet_mpeg.data[i]); + } + break; + case AUDIF_PACKETS: + sp_reg_write(anx78xx, TX_P2, SP_INFOFRAME_AUD_TYPE_REG, + sp.tx_packet_audio.infoframe.type); + sp_reg_write(anx78xx, TX_P2, SP_INFOFRAME_AUD_VER_REG, + sp.tx_packet_audio.infoframe.version); + sp_reg_write(anx78xx, TX_P2, SP_INFOFRAME_AUD_LEN_REG, + sp.tx_packet_audio.infoframe.length); + for (i = 0; i < sp.tx_packet_audio.infoframe.length; i++) { + sp_reg_write(anx78xx, TX_P2, + SP_INFOFRAME_AUD_DB0_REG + i, + sp.tx_packet_audio.data[i]); + } + break; + default: + break; + } +} + +static void sp_config_packets(struct anx78xx *anx78xx, enum packets_type type) +{ + switch (type) { + case AVI_PACKETS: + sp_reg_clear_bits(anx78xx, TX_P0, SP_PACKET_SEND_CTRL_REG, + SP_AVI_IF_EN); + sp_load_packet(anx78xx, AVI_PACKETS); + sp_reg_set_bits(anx78xx, TX_P0, SP_PACKET_SEND_CTRL_REG, + SP_AVI_IF_UD); + sp_reg_set_bits(anx78xx, TX_P0, SP_PACKET_SEND_CTRL_REG, + SP_AVI_IF_EN); + break; + case VSI_PACKETS: + sp_reg_clear_bits(anx78xx, TX_P0, SP_PACKET_SEND_CTRL_REG, + SP_MPEG_IF_EN); + sp_load_packet(anx78xx, VSI_PACKETS); + sp_reg_set_bits(anx78xx, TX_P0, SP_PACKET_SEND_CTRL_REG, + SP_MPEG_IF_UD); + sp_reg_set_bits(anx78xx, TX_P0, SP_PACKET_SEND_CTRL_REG, + SP_MPEG_IF_EN); + break; + case MPEG_PACKETS: + sp_reg_clear_bits(anx78xx, TX_P0, SP_PACKET_SEND_CTRL_REG, + SP_MPEG_IF_EN); + sp_load_packet(anx78xx, MPEG_PACKETS); + sp_reg_set_bits(anx78xx, TX_P0, SP_PACKET_SEND_CTRL_REG, + SP_MPEG_IF_UD); + sp_reg_set_bits(anx78xx, TX_P0, SP_PACKET_SEND_CTRL_REG, + SP_MPEG_IF_EN); + break; + case AUDIF_PACKETS: + sp_reg_clear_bits(anx78xx, TX_P0, SP_PACKET_SEND_CTRL_REG, + SP_AUD_IF_EN); + sp_load_packet(anx78xx, AUDIF_PACKETS); + sp_reg_set_bits(anx78xx, TX_P0, SP_PACKET_SEND_CTRL_REG, + SP_AUD_IF_UP); + sp_reg_set_bits(anx78xx, TX_P0, SP_PACKET_SEND_CTRL_REG, + SP_AUD_IF_EN); + break; + default: + break; + } +} + +static bool sp_config_video_output(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + u8 val; + + switch (sp.tx_vo_state) { + default: + case VO_WAIT_VIDEO_STABLE: + sp_reg_read(anx78xx, RX_P0, SP_SYSTEM_STATUS_REG, &val); + if ((val & SP_TMDS_DE_DET) && (val & SP_TMDS_CLOCK_DET)) { + sp_tx_bw_lc_sel(anx78xx); + sp_enable_video_input(anx78xx, false); + sp_packet_avi_init(anx78xx); + sp_config_packets(anx78xx, AVI_PACKETS); + sp_set_colorspace(anx78xx); + sp_lvttl_bit_mapping(anx78xx); + sp_reg_read(anx78xx, RX_P0, + SP_PACKET_RECEIVING_STATUS_REG, &val); + if (val & SP_VSI_RCVD) + sp_hdmi_new_vsi_int(anx78xx); + sp_enable_video_input(anx78xx, true); + sp.tx_vo_state = VO_WAIT_TX_VIDEO_STABLE; + } else { + dev_dbg(dev, "HDMI input video not stable!\n"); + break; + } + /* fallthrough */ + case VO_WAIT_TX_VIDEO_STABLE: + /* + * The flag is write clear and can be latched from last + * status. So the first read and write is to clear the + * previous status. + */ + sp_reg_read(anx78xx, TX_P0, SP_DP_SYSTEM_CTRL_BASE + 2, &val); + sp_reg_write(anx78xx, TX_P0, SP_DP_SYSTEM_CTRL_BASE + 2, val); + + sp_reg_read(anx78xx, TX_P0, SP_DP_SYSTEM_CTRL_BASE + 2, &val); + if (val & SP_CHA_STA) { + dev_dbg(dev, "stream clock not stable!\n"); + break; + } else { + /* + * The flag is write clear and can be latched from + * last status. So the first read and write is to + * clear the previous status. + */ + sp_reg_read(anx78xx, TX_P0, + SP_DP_SYSTEM_CTRL_BASE + 3, + &val); + sp_reg_write(anx78xx, TX_P0, + SP_DP_SYSTEM_CTRL_BASE + 3, + val); + + sp_reg_read(anx78xx, TX_P0, + SP_DP_SYSTEM_CTRL_BASE + 3, + &val); + if (val & SP_STRM_VALID) { + if (sp.tx_test_lt) + sp.tx_test_lt = false; + sp.tx_vo_state = VO_FINISH; + } else { + dev_err(dev, "video stream not valid!\n"); + break; + } + } + /* fallthrough */ + case VO_FINISH: + sp_block_power_ctrl(anx78xx, SP_TX_PWR_AUDIO, false); + sp_hdmi_mute_video(anx78xx, false); + sp_video_mute(anx78xx, false); + sp_show_information(anx78xx); + return true; + } + + return false; +} + +/******************End Output video process********************/ + +/******************Start HDCP process********************/ +static inline void sp_hdcp_encryption_disable(struct anx78xx *anx78xx) +{ + sp_reg_clear_bits(anx78xx, TX_P0, SP_HDCP_CTRL0_REG, SP_HDCP_ENC_EN); +} + +static inline void sp_hdcp_encryption_enable(struct anx78xx *anx78xx) +{ + sp_reg_set_bits(anx78xx, TX_P0, SP_HDCP_CTRL0_REG, SP_HDCP_ENC_EN); +} + +static void sp_hw_hdcp_enable(struct anx78xx *anx78xx) +{ + sp_reg_clear_bits(anx78xx, TX_P0, SP_HDCP_CTRL0_REG, + SP_HDCP_ENC_EN | SP_HARD_AUTH_EN); + sp_reg_set_bits(anx78xx, TX_P0, SP_HDCP_CTRL0_REG, + SP_HARD_AUTH_EN | SP_BKSV_SRM_PASS | + SP_KSVLIST_VLD | SP_HDCP_ENC_EN); + + /* + * Set the wait timing value for R0 checking of HDCP first step + * authentication after write AKSV to receiver. Default value is + * 0x64 (100ms). + */ + sp_reg_write(anx78xx, TX_P0, SP_HDCP_WAIT_R0_TIME_REG, 0xb0); + + /* + * Set the wait timing value for repeater KSVFIFO ready in HDCP first + * step authentication. Default value is 0x9c (4.2s) + */ + sp_reg_write(anx78xx, TX_P0, SP_HDCP_RPTR_RDY_WAIT_TIME_REG, 0xc8); +} + +static bool sp_hdcp_process(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + + switch (sp.hdcp_state) { + case HDCP_CAPABLE_CHECK: + sp.hdcp_fail_count = 0; + if (is_anx_dongle(anx78xx)) + sp.hdcp_state = HDCP_WAITING_VID_STB; + else + sp.hdcp_state = HDCP_HW_ENABLE; + if (!sp.hdcp_enabled) + sp.hdcp_state = HDCP_NOT_SUPPORTED; + if (sp.hdcp_state != HDCP_WAITING_VID_STB) + break; + /* fallthrough */ + case HDCP_WAITING_VID_STB: + msleep(100); + sp.hdcp_state = HDCP_HW_ENABLE; + /* fallthrough */ + case HDCP_HW_ENABLE: + sp_video_mute(anx78xx, true); + sp_clean_hdcp_status(anx78xx); + sp_block_power_ctrl(anx78xx, SP_TX_PWR_HDCP, false); + msleep(20); + sp_block_power_ctrl(anx78xx, SP_TX_PWR_HDCP, true); + sp_reg_write(anx78xx, TX_P2, SP_COMMON_INT_MASK_BASE + 2, + 0x01); + msleep(50); + sp_hw_hdcp_enable(anx78xx); + sp.hdcp_state = HDCP_WAITING_FINISH; + /* fallthrough */ + case HDCP_WAITING_FINISH: + break; + case HDCP_FINISH: + sp_hdcp_encryption_enable(anx78xx); + sp_hdmi_mute_video(anx78xx, false); + sp_video_mute(anx78xx, false); + sp.hdcp_state = HDCP_CAPABLE_CHECK; + dev_dbg(dev, "HDCP authentication pass\n"); + return true; + case HDCP_FAILED: + if (sp.hdcp_fail_count > 5) { + sp_reg_hardware_reset(anx78xx); + sp.hdcp_state = HDCP_CAPABLE_CHECK; + sp.hdcp_fail_count = 0; + dev_dbg(dev, "HDCP authentication failed\n"); + } else { + sp.hdcp_fail_count++; + sp.hdcp_state = HDCP_WAITING_VID_STB; + } + break; + default: + case HDCP_NOT_SUPPORTED: + dev_dbg(dev, "sink is not capable HDCP\n"); + sp_block_power_ctrl(anx78xx, SP_TX_PWR_HDCP, false); + sp_video_mute(anx78xx, false); + sp.hdcp_state = HDCP_CAPABLE_CHECK; + return true; + } + + return false; +} + +/******************End HDCP process********************/ + +/******************Start Audio process********************/ +static void sp_packet_audio_init(struct anx78xx *anx78xx) +{ + int i; + u8 val; + + sp.tx_packet_audio.infoframe.type = HDMI_INFOFRAME_TYPE_AUDIO; + sp.tx_packet_audio.infoframe.version = 1; + sp.tx_packet_audio.infoframe.length = HDMI_AUDIO_INFOFRAME_SIZE; + + for (i = 0; i < sp.tx_packet_audio.infoframe.length; i++) { + sp_reg_read(anx78xx, RX_P1, SP_AUD_INFOFRAME_DATA_BASE + i, + &val); + sp.tx_packet_audio.data[i] = val; + } +} + +static void sp_enable_audio_output(struct anx78xx *anx78xx, bool enable) +{ + u8 val; + + sp_reg_clear_bits(anx78xx, TX_P0, SP_DP_AUDIO_CTRL_REG, SP_AUD_EN); + if (enable) { + sp_packet_audio_init(anx78xx); + sp_config_packets(anx78xx, AUDIF_PACKETS); + + sp_reg_read(anx78xx, RX_P0, SP_HDMI_STATUS_REG, &val); + if (val & SP_HDMI_AUD_LAYOUT) { + sp_reg_read(anx78xx, RX_P1, SP_AUD_INFOFRAME_DATA_BASE, + &val); + sp_reg_write(anx78xx, TX_P2, SP_AUD_CH_STATUS_BASE + 5, + (val & 0x07) << 5 | SP_AUDIO_LAYOUT); + } else { + sp_reg_write(anx78xx, TX_P2, SP_AUD_CH_STATUS_BASE + 5, + SP_I2S_CH_NUM_2 & ~SP_AUDIO_LAYOUT); + } + sp_reg_set_bits(anx78xx, TX_P0, SP_DP_AUDIO_CTRL_REG, + SP_AUD_EN); + } else { + sp_reg_clear_bits(anx78xx, TX_P0, SP_PACKET_SEND_CTRL_REG, + SP_AUD_IF_EN); + } +} + +static int sp_calculate_audio_m_value(struct anx78xx *anx78xx) +{ + u8 val; + struct device *dev = &anx78xx->client->dev; + unsigned long m_aud, ls_clk = 0; + unsigned long aud_freq = 0; + + sp_reg_read(anx78xx, RX_P0, SP_AUD_SPDIF_CH_STATUS_BASE + 4, &val); + + switch (val & SP_FS_FREQ_MASK) { + case SP_FS_FREQ_44100HZ: + aud_freq = 44100; + break; + case SP_FS_FREQ_48000HZ: + aud_freq = 48000; + break; + case SP_FS_FREQ_32000HZ: + aud_freq = 32000; + break; + case SP_FS_FREQ_88200HZ: + aud_freq = 88200; + break; + case SP_FS_FREQ_96000HZ: + aud_freq = 96000; + break; + case SP_FS_FREQ_176400HZ: + aud_freq = 176400; + break; + case SP_FS_FREQ_192000HZ: + aud_freq = 192000; + break; + default: + dev_err(dev, "invalid sampling clock frequency %d\n", + val & SP_FS_FREQ_MASK); + return -1; + } + + switch (sp_get_link_bw(anx78xx)) { + case SP_LINK_1P62G: + ls_clk = 162000; + break; + case SP_LINK_2P7G: + ls_clk = 270000; + break; + case SP_LINK_5P4G: + ls_clk = 540000; + break; + case SP_LINK_6P75G: + ls_clk = 675000; + break; + default: + dev_err(dev, "invalid main link bandwidth setting\n"); + return -1; + } + + dev_dbg(dev, "aud_freq = %ld , LS_CLK = %ld\n", aud_freq, ls_clk); + + m_aud = (((512 * aud_freq) / ls_clk) * 32768) / 1000; + sp_reg_write(anx78xx, TX_P1, SP_AUD_INTERFACE_CTRL4_REG, m_aud & 0xff); + m_aud = m_aud >> 8; + sp_reg_write(anx78xx, TX_P1, SP_AUD_INTERFACE_CTRL5_REG, m_aud & 0xff); + sp_reg_write(anx78xx, TX_P1, SP_AUD_INTERFACE_CTRL6_REG, 0x00); + + return 0; +} + +static void sp_config_audio(struct anx78xx *anx78xx) +{ + int i; + u8 val; + + sp_block_power_ctrl(anx78xx, SP_TX_PWR_AUDIO, true); + + sp_reg_read(anx78xx, TX_P0, SP_DP_MAIN_LINK_BW_SET_REG, &val); + if (val & SP_INITIAL_SLIM_M_AUD_SEL) + if (sp_calculate_audio_m_value(anx78xx)) + return; + + sp_reg_clear_bits(anx78xx, TX_P1, SP_AUD_INTERFACE_CTRL0_REG, + SP_AUD_INTERFACE_DISABLE); + + sp_reg_set_bits(anx78xx, TX_P1, SP_AUD_INTERFACE_CTRL2_REG, + SP_M_AUD_ADJUST_ST); + + sp_reg_read(anx78xx, RX_P0, SP_HDMI_STATUS_REG, &val); + if (val & SP_HDMI_AUD_LAYOUT) + sp_reg_set_bits(anx78xx, TX_P2, SP_AUD_CH_STATUS_BASE + 5, + SP_I2S_CH_NUM_8 | SP_AUDIO_LAYOUT); + else + sp_reg_clear_bits(anx78xx, TX_P2, SP_AUD_CH_STATUS_BASE + 5, + SP_I2S_CHANNEL_NUM_MASK | SP_AUDIO_LAYOUT); + + /* transfer audio channel status from HDMI Rx to Slimport Tx */ + for (i = 1; i <= SP_AUD_CH_STATUS_REG_NUM; i++) { + sp_reg_read(anx78xx, RX_P0, SP_AUD_SPDIF_CH_STATUS_BASE + i, + &val); + sp_reg_write(anx78xx, TX_P2, SP_AUD_CH_STATUS_BASE + i, + val); + } + + /* enable audio */ + sp_enable_audio_output(anx78xx, true); +} + +static bool sp_config_audio_output(struct anx78xx *anx78xx) +{ + u8 val; + + switch (sp.tx_ao_state) { + default: + case AO_INIT: + case AO_CTS_RCV_INT: + case AO_AUDIO_RCV_INT: + sp_reg_read(anx78xx, RX_P0, SP_HDMI_STATUS_REG, &val); + if (!val & SP_HDMI_MODE) { + sp.tx_ao_state = AO_INIT; + return true; + } + break; + case AO_RCV_INT_FINISH: + if (sp.audio_stable_count++ > 2) { + sp.tx_ao_state = AO_OUTPUT; + } else { + sp.tx_ao_state = AO_INIT; + break; + } + /* fallthrough */ + case AO_OUTPUT: + sp.audio_stable_count = 0; + sp.tx_ao_state = AO_INIT; + sp_video_mute(anx78xx, false); + sp_hdmi_mute_audio(anx78xx, false); + sp_config_audio(anx78xx); + return true; + } + + return false; +} + +/******************End Audio process********************/ + +static void sp_initialization(struct anx78xx *anx78xx) +{ + sp.read_edid_flag = false; + + /* Power on all modules */ + sp_reg_write(anx78xx, TX_P2, SP_POWERDOWN_CTRL_REG, 0x00); + /* Driver Version */ + sp_reg_write(anx78xx, TX_P1, SP_FW_VER_REG, FW_VERSION); + sp_hdmi_initialization(anx78xx); + sp_tx_initialization(anx78xx); + msleep(200); +} + +/* + * Interrupt receiver function, gets the service interrupts and updates the + * status of the interrupts so that correct interrupt service routines can + * be called in the SlimPort task handler function. + */ +static void sp_int_receiver(struct anx78xx *anx78xx) +{ + int i; + + /* Common Interrupt Status Registers */ + for (i = 0; i < ARRAY_SIZE(sp.common_int); i++) { + sp_reg_read(anx78xx, TX_P2, SP_COMMON_INT_STATUS_BASE + 1 + i, + &sp.common_int[i]); + sp_reg_write(anx78xx, TX_P2, SP_COMMON_INT_STATUS_BASE + 1 + i, + sp.common_int[i]); + } + + /* Display Port Interrupt Status Register */ + sp_reg_read(anx78xx, TX_P2, SP_DP_INT_STATUS_REG, &sp.dp_int); + sp_reg_write(anx78xx, TX_P2, SP_DP_INT_STATUS_REG, sp.dp_int); + + /* Interrupt Status Registers */ + for (i = 0; i < ARRAY_SIZE(sp.sp_hdmi_int); i++) { + sp_reg_read(anx78xx, RX_P0, SP_INT_STATUS1_REG + i, + &sp.sp_hdmi_int[i]); + sp_reg_write(anx78xx, RX_P0, SP_INT_STATUS1_REG + i, + sp.sp_hdmi_int[i]); + } +} + +/******************Start task process********************/ +static void sp_pll_changed_int_handler(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + + if (sp.tx_system_state >= STATE_LINK_TRAINING) { + if (!sp_get_pll_lock_status(anx78xx)) { + dev_dbg(dev, "PLL not lock!\n"); + sp_set_system_state(anx78xx, STATE_LINK_TRAINING); + } + } +} + +static void sp_phy_auto_test(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + u8 b_sw; + u8 buf[16]; + int i; + + /* DPCD 0x219 TEST_LINK_RATE */ + sp_aux_dpcdread_bytes(anx78xx, 0x0, 0x02, 0x19, 1, buf); + dev_dbg(dev, "DPCD: 0x00219 = %.2x\n", buf[0]); + switch (buf[0]) { + case SP_LINK_1P62G: + case SP_LINK_2P7G: + case SP_LINK_5P4G: + case SP_LINK_6P75G: + sp_set_link_bw(anx78xx, buf[0]); + sp.tx_test_bw = buf[0]; + break; + default: + sp_set_link_bw(anx78xx, SP_LINK_6P75G); + sp.tx_test_bw = SP_LINK_6P75G; + break; + } + + /* DPCD 0x248 PHY_TEST_PATTERN */ + sp_aux_dpcdread_bytes(anx78xx, 0x0, 0x02, 0x48, 1, buf); + dev_dbg(dev, "DPCD: 0x00248 = %.2x\n", buf[0]); + switch (buf[0]) { + case 0: + break; + case 1: + sp_reg_write(anx78xx, TX_P0, SP_DP_TRAINING_PATTERN_SET_REG, + 0x04); + break; + case 2: + sp_reg_write(anx78xx, TX_P0, SP_DP_TRAINING_PATTERN_SET_REG, + 0x08); + break; + case 3: + sp_reg_write(anx78xx, TX_P0, SP_DP_TRAINING_PATTERN_SET_REG, + 0x0c); + break; + case 4: + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x02, 0x50, 10, + buf); + for (i = 0; i < SP_DP_LT_80BIT_PATTERN_REG_NUM; i++) { + sp_reg_write(anx78xx, TX_P1, + SP_DP_LT_80BIT_PATTERN0_REG + i, + buf[0]); + } + sp_reg_write(anx78xx, TX_P0, SP_DP_TRAINING_PATTERN_SET_REG, + 0x30); + break; + case 5: + sp_reg_write(anx78xx, TX_P0, SP_DP_CEP_TRAINING_CTRL0_REG, + 0x00); + sp_reg_write(anx78xx, TX_P0, SP_DP_CEP_TRAINING_CTRL1_REG, + 0x01); + sp_reg_write(anx78xx, TX_P0, SP_DP_TRAINING_PATTERN_SET_REG, + 0x14); + break; + } + + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x00, 0x03, 1, buf); + dev_dbg(dev, "DPCD: 0x00003 = %.2x\n", buf[0]); + if (buf[0] & 0x01) + sp_config_ssc(anx78xx, SSC_DEP_4000PPM); + else + sp_downspeading_enable(anx78xx, false); + + /* get swing and emphasis adjust request */ + sp_reg_read(anx78xx, TX_P0, SP_DP_LANE0_LT_CTRL_REG, &b_sw); + + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x02, 0x06, 1, buf); + dev_dbg(dev, "DPCD: 0x00206 = %.2x\n", buf[0]); + switch (buf[0] & 0x0f) { + case 0x00: + case 0x01: + case 0x02: + case 0x03: + sp_reg_write(anx78xx, TX_P0, SP_DP_LANE0_LT_CTRL_REG, + (b_sw & ~SP_TX_SW_SET_MASK) | (buf[0] & 0x0f)); + break; + case 0x04: + case 0x05: + case 0x06: + sp_reg_write(anx78xx, TX_P0, SP_DP_LANE0_LT_CTRL_REG, + (b_sw & ~SP_TX_SW_SET_MASK) | + ((buf[0] & 0x0f) + 4)); + break; + case 0x08: + sp_reg_write(anx78xx, TX_P0, SP_DP_LANE0_LT_CTRL_REG, + (b_sw & ~SP_TX_SW_SET_MASK) | 0x10); + break; + case 0x09: + sp_reg_write(anx78xx, TX_P0, SP_DP_LANE0_LT_CTRL_REG, + (b_sw & ~SP_TX_SW_SET_MASK) | 0x11); + break; + case 0x0c: + sp_reg_write(anx78xx, TX_P0, SP_DP_LANE0_LT_CTRL_REG, + (b_sw & ~SP_TX_SW_SET_MASK) | 0x18); + break; + default: + break; + } +} + +static void sp_hpd_irq_process(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + u8 val; + u8 test_vector; + u8 buf[6]; + + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x02, 0x00, 6, buf); + dev_dbg(dev, "get HPD IRQ %x\n", buf[1]); + + if (buf[1] != 0) + sp_aux_dpcdwrite_bytes(anx78xx, 0x00, 0x02, + SP_DPCD_SERVICE_IRQ_VECTOR, 1, + &buf[1]); + + /* HDCP IRQ */ + if ((buf[1] & SP_CP_IRQ) && + (sp.hdcp_state > HDCP_WAITING_FINISH || + sp.tx_system_state >= STATE_HDCP_AUTH)) { + sp_aux_dpcdread_bytes(anx78xx, 0x06, 0x80, 0x29, 1, + &val); + if (val & 0x04) { + if (!sp_hdcp_repeater_mode(anx78xx)) { + sp_set_system_state(anx78xx, STATE_HDCP_AUTH); + sp_clean_hdcp_status(anx78xx); + } else { + sp.repeater_state = HDCP_ERROR; + } + dev_dbg(dev, "CP_IRQ, HDCP sync lost.\n"); + } + } + + /* PHY and Link CTS test */ + if (buf[1] & SP_TEST_IRQ) { + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x02, 0x18, 1, + &test_vector); + + if (test_vector & 0x01) { + sp.tx_test_lt = true; + + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x02, 0x19, 1, + &val); + switch (val) { + case SP_LINK_1P62G: + case SP_LINK_2P7G: + case SP_LINK_5P4G: + case SP_LINK_6P75G: + sp_set_link_bw(anx78xx, val); + sp.tx_test_bw = val; + break; + default: + sp_set_link_bw(anx78xx, SP_LINK_6P75G); + sp.tx_test_bw = SP_LINK_6P75G; + break; + } + + dev_dbg(dev, "Test bandwidth %.2x\n", sp.tx_test_bw); + + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x02, 0x60, 1, + &val); + val = val | SP_TEST_ACK; + sp_aux_dpcdwrite_bytes(anx78xx, 0x00, 0x02, 0x60, 1, + &val); + + dev_dbg(dev, "Set TEST_ACK!\n"); + if (sp.tx_system_state >= STATE_LINK_TRAINING) { + sp.tx_lt_state = LT_INIT; + sp_set_system_state(anx78xx, + STATE_LINK_TRAINING); + } + dev_dbg(dev, "IRQ: test-LT request!\n"); + } + + if (test_vector & 0x02) { + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x02, 0x60, 1, + &val); + val = val | SP_TEST_ACK; + sp_aux_dpcdwrite_bytes(anx78xx, 0x00, 0x02, 0x60, 1, + &val); + } + if (test_vector & 0x04) { + if (sp.tx_system_state > STATE_PARSE_EDID) + sp_set_system_state(anx78xx, STATE_PARSE_EDID); + sp.tx_test_edid = true; + dev_dbg(dev, "test EDID Requested!\n"); + } + + if (test_vector & 0x08) { + sp.tx_test_lt = true; + + sp_phy_auto_test(anx78xx); + + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x02, 0x60, 1, + &val); + val = val | 0x01; + sp_aux_dpcdwrite_bytes(anx78xx, 0x00, 0x02, 0x60, 1, + &val); + } + } + + if (sp.tx_system_state > STATE_LINK_TRAINING) { + if ((sp.tx_system_state == STATE_HDCP_AUTH) && + (buf[1] & SP_CP_IRQ)) { + dev_dbg(dev, "CP IRQ!\n"); + } else if (!(buf[4] & 0x01) || ((buf[2] & 0x05) != 0x05)) { + sp_set_system_state(anx78xx, STATE_LINK_TRAINING); + dev_dbg(dev, "IRQ: re-LT request!\n"); + return; + } + + dev_dbg(dev, "lane align %x\n", buf[4]); + dev_dbg(dev, "lane clock recovery %x\n", buf[2]); + } +} + +static void sp_packet_vsi_init(struct anx78xx *anx78xx) +{ + u8 val; + int i; + + sp.tx_packet_vsi.infoframe.type = HDMI_INFOFRAME_TYPE_VENDOR; + sp.tx_packet_vsi.infoframe.version = 1; + sp.tx_packet_vsi.infoframe.length = HDMI_VSI_INFOFRAME_SIZE; + + for (i = 0; i < sp.tx_packet_vsi.infoframe.length; i++) { + sp_reg_read(anx78xx, RX_P1, SP_MPEG_VS_INFOFRAME_DATA_BASE + i, + &val); + sp.tx_packet_mpeg.data[i] = val; + } +} + +static void sp_packet_mpeg_init(struct anx78xx *anx78xx) +{ + u8 val; + int i; + + sp.tx_packet_mpeg.infoframe.type = HDMI_INFOFRAME_TYPE_MPEG; + sp.tx_packet_mpeg.infoframe.version = 1; + sp.tx_packet_mpeg.infoframe.length = HDMI_MPEG_INFOFRAME_SIZE; + + for (i = 0; i < sp.tx_packet_mpeg.infoframe.length; i++) { + sp_reg_read(anx78xx, RX_P1, SP_MPEG_VS_INFOFRAME_DATA_BASE + i, + &val); + sp.tx_packet_mpeg.data[i] = val; + } +} + +static void sp_auth_done_int_handler(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + u8 buf[2]; + + if (sp_hdcp_repeater_mode(anx78xx)) { + sp_reg_read(anx78xx, TX_P0, SP_TX_HDCP_STATUS_REG, &buf[0]); + if ((buf[0] & SP_AUTHEN_PASS) && + (sp.repeater_state == HDCP_DOING)) + sp.repeater_state = HDCP_DONE; + else + sp.repeater_state = HDCP_ERROR; + + return; + } + + if (sp.hdcp_state > HDCP_HW_ENABLE && + sp.tx_system_state == STATE_HDCP_AUTH) { + sp_reg_read(anx78xx, TX_P0, SP_HDCP_RX_BSTATUS0_REG, &buf[0]); + sp_reg_read(anx78xx, TX_P0, SP_HDCP_RX_BSTATUS1_REG, &buf[1]); + if ((buf[0] & 0x08) || (buf[1] & 0x80)) { + dev_dbg(dev, "max cascade/devs exceeded!\n"); + sp_hdcp_encryption_disable(anx78xx); + sp.hdcp_state = HDCP_FINISH; + } else { + sp_reg_read(anx78xx, TX_P0, SP_TX_HDCP_STATUS_REG, + buf); + } + + if (buf[0] & SP_AUTHEN_PASS) { + sp_aux_dpcdread_bytes(anx78xx, 0x06, 0x80, 0x2a, 2, + buf); + if ((buf[0] & 0x08) || (buf[1] & 0x80)) { + dev_dbg(dev, "max cascade/devs exceeded!\n"); + sp_hdcp_encryption_disable(anx78xx); + } else + dev_dbg(dev, "%s\n", + "authentication pass in Auth Done"); + + sp.hdcp_state = HDCP_FINISH; + } else { + dev_err(dev, "authentication failed in Auth Done\n"); + sp_video_mute(anx78xx, true); + sp_clean_hdcp_status(anx78xx); + sp.hdcp_state = HDCP_FAILED; + } + } +} + +static void sp_lt_done_int_handler(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + u8 val; + + if (sp.tx_lt_state == LT_WAITING_FINISH && + sp.tx_system_state == STATE_LINK_TRAINING) { + sp_reg_read(anx78xx, TX_P0, SP_DP_LT_CTRL_REG, &val); + if (val & SP_LT_ERROR_TYPE_MASK) { + val = (val & SP_LT_ERROR_TYPE_MASK) >> 4; + dev_dbg(dev, "LT failed in interrupt %.2x\n", + val); + sp.tx_lt_state = LT_ERROR; + } else { + dev_dbg(dev, "LT finish\n"); + sp.tx_lt_state = LT_FINISH; + } + } +} + +static void sp_hdmi_clk_det_int(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + + dev_dbg(dev, "pixel clock change\n"); + if (sp.tx_system_state > STATE_VIDEO_OUTPUT) { + sp_video_mute(anx78xx, true); + sp_enable_audio_output(anx78xx, false); + sp_set_system_state(anx78xx, STATE_VIDEO_OUTPUT); + } +} + +static void sp_hdmi_dvi_int(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + u8 val; + + sp_reg_read(anx78xx, RX_P0, SP_HDMI_STATUS_REG, &val); + if ((val & SP_HDMI_DET) == SP_DVI_MODE) { + dev_dbg(dev, "detected DVI MODE -> mute audio\n"); + sp_hdmi_mute_audio(anx78xx, true); + sp_set_system_state(anx78xx, STATE_LINK_TRAINING); + } +} + +static void sp_hdmi_new_avi_int(struct anx78xx *anx78xx) +{ + sp_lvttl_bit_mapping(anx78xx); + sp_set_colorspace(anx78xx); + sp_packet_avi_init(anx78xx); + sp_config_packets(anx78xx, AVI_PACKETS); +} + +static void sp_hdmi_new_vsi_int(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + u8 hdmi_video_format, v3d_structure, mpeg_type, mpeg_ver; + + sp_reg_clear_bits(anx78xx, TX_P0, SP_DP_3D_VSC_CTRL_REG, + SP_INFO_FRAME_VSC_EN); + + /* VSI package header */ + sp_reg_read(anx78xx, RX_P1, SP_MPEG_VS_INFOFRAME_TYPE_REG, &mpeg_type); + sp_reg_read(anx78xx, RX_P1, SP_MPEG_VS_INFOFRAME_VER_REG, &mpeg_ver); + if ((mpeg_type || mpeg_ver) != 0x01) + return; + + dev_dbg(dev, "setup VSI package!\n"); + + sp_packet_vsi_init(anx78xx); + sp_config_packets(anx78xx, VSI_PACKETS); + + sp_reg_read(anx78xx, RX_P1, SP_MPEG_VS_INFOFRAME_DATA_BASE + 3, + &hdmi_video_format); + + if ((hdmi_video_format & 0xe0) == 0x40) { + dev_dbg(dev, "3D VSI packet detected. Config VSC packet\n"); + + sp_reg_read(anx78xx, RX_P1, SP_MPEG_VS_INFOFRAME_DATA_BASE + 5, + &v3d_structure); + + switch (v3d_structure & 0xf0) { + case 0x00: + v3d_structure = 0x02; + break; + case 0x20: + v3d_structure = 0x03; + break; + case 0x30: + v3d_structure = 0x04; + break; + default: + v3d_structure = 0x00; + dev_dbg(dev, "3D structure is not supported\n"); + break; + } + sp_reg_write(anx78xx, TX_P0, SP_DP_VSC_DB1_REG, v3d_structure); + } + sp_reg_set_bits(anx78xx, TX_P0, SP_DP_3D_VSC_CTRL_REG, + SP_INFO_FRAME_VSC_EN); + sp_reg_clear_bits(anx78xx, TX_P0, SP_PACKET_SEND_CTRL_REG, + SP_SPD_IF_EN); + sp_reg_set_bits(anx78xx, TX_P0, SP_PACKET_SEND_CTRL_REG, SP_SPD_IF_UD); + sp_reg_set_bits(anx78xx, TX_P0, SP_PACKET_SEND_CTRL_REG, SP_SPD_IF_EN); +} + +static void sp_hdmi_no_vsi_int(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + u8 val; + + sp_reg_read(anx78xx, TX_P0, SP_DP_3D_VSC_CTRL_REG, &val); + if (val & SP_INFO_FRAME_VSC_EN) { + dev_dbg(dev, "no new VSI is received, disable VSC packet\n"); + val &= ~SP_INFO_FRAME_VSC_EN; + sp_reg_write(anx78xx, TX_P0, SP_DP_3D_VSC_CTRL_REG, val); + sp_packet_mpeg_init(anx78xx); + sp_config_packets(anx78xx, MPEG_PACKETS); + } +} + +static inline void sp_hdmi_restart_audio_chk(struct anx78xx *anx78xx) +{ + sp_set_system_state(anx78xx, STATE_AUDIO_OUTPUT); +} + +static void sp_hdmi_cts_rcv_int(struct anx78xx *anx78xx) +{ + if (sp.tx_ao_state == AO_INIT) + sp.tx_ao_state = AO_CTS_RCV_INT; + else if (sp.tx_ao_state == AO_AUDIO_RCV_INT) + sp.tx_ao_state = AO_RCV_INT_FINISH; +} + +static void sp_hdmi_audio_rcv_int(struct anx78xx *anx78xx) +{ + if (sp.tx_ao_state == AO_INIT) + sp.tx_ao_state = AO_AUDIO_RCV_INT; + else if (sp.tx_ao_state == AO_CTS_RCV_INT) + sp.tx_ao_state = AO_RCV_INT_FINISH; +} + +static void sp_hdmi_audio_samplechg_int(struct anx78xx *anx78xx) +{ + u16 i; + u8 val; + + /* transfer audio channel status from HDMI Rx to Slimport Tx */ + for (i = 0; i < SP_AUD_CH_STATUS_REG_NUM; i++) { + sp_reg_read(anx78xx, RX_P0, SP_AUD_SPDIF_CH_STATUS_BASE + i, + &val); + sp_reg_write(anx78xx, TX_P2, SP_AUD_CH_STATUS_BASE + i, + val); + } +} + +static void sp_hdmi_hdcp_error_int(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + + if (sp.hdcp_error_count >= 40) { + sp.hdcp_error_count = 0; + dev_dbg(dev, "lots of hdcp error occurred!\n"); + sp_hdmi_mute_audio(anx78xx, true); + sp_hdmi_mute_video(anx78xx, true); + sp_hdmi_set_hpd(anx78xx, false); + usleep_range(10000, 11000); + sp_hdmi_set_hpd(anx78xx, true); + } else { + sp.hdcp_error_count++; + } +} + +static void sp_hdmi_new_gcp_int(struct anx78xx *anx78xx) +{ + u8 val; + + sp_reg_read(anx78xx, RX_P1, SP_GENERAL_CTRL_PACKET_REG, &val); + if (val & SP_SET_AVMUTE) { + sp_hdmi_mute_video(anx78xx, true); + sp_hdmi_mute_audio(anx78xx, true); + } else if (val & SP_CLEAR_AVMUTE) { + sp_hdmi_mute_video(anx78xx, false); + sp_hdmi_mute_audio(anx78xx, false); + } +} + +static void sp_hpd_int_handler(struct anx78xx *anx78xx, u8 hpd_source) +{ + u8 val; + struct device *dev = &anx78xx->client->dev; + + switch (hpd_source) { + case SP_HPD_LOST: + sp_hdmi_set_hpd(anx78xx, false); + sp_set_system_state(anx78xx, STATE_WAITING_CABLE_PLUG); + break; + case SP_HPD_CHG: + dev_dbg(dev, "HPD changed!\n"); + usleep_range(2000, 4000); + if (sp.common_int[3] & SP_HPD_IRQ) + sp_hpd_irq_process(anx78xx); + + sp_reg_read(anx78xx, TX_P0, SP_DP_SYSTEM_CTRL_BASE + 3, &val); + if (val & SP_HPD_STATUS) { + if (sp.common_int[3] & SP_HPD_IRQ) + sp_hpd_irq_process(anx78xx); + } else { + sp_reg_read(anx78xx, TX_P0, + SP_DP_SYSTEM_CTRL_BASE + 3, + &val); + if (val & SP_HPD_STATUS) { + sp_hdmi_set_hpd(anx78xx, false); + sp_set_system_state(anx78xx, + STATE_WAITING_CABLE_PLUG); + } + } + break; + default: + break; + } +} + +static void sp_system_isr_handler(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + + if (sp.tx_system_state == STATE_WAITING_CABLE_PLUG) { + if (sp.common_int[3] & SP_HPD_PLUG) + sp_hpd_int_handler(anx78xx, SP_HPD_PLUG); + } else { + if (sp.common_int[3] & SP_HPD_CHG) + sp_hpd_int_handler(anx78xx, SP_HPD_CHG); + else if (sp.common_int[3] & SP_HPD_LOST) + sp_hpd_int_handler(anx78xx, SP_HPD_LOST); + } + + if (sp.common_int[0] & SP_PLL_LOCK_CHG) + sp_pll_changed_int_handler(anx78xx); + + if (sp.common_int[1] & SP_HDCP_AUTH_DONE) + sp_auth_done_int_handler(anx78xx); + + if ((sp.common_int[2] & SP_HDCP_LINK_CHECK_FAIL) && + !sp_hdcp_repeater_mode(anx78xx)) { + sp_set_system_state(anx78xx, STATE_LINK_TRAINING); + dev_dbg(dev, "HDCP Sync Lost!\n"); + } + + if (sp.dp_int & SP_TRAINING_FINISH) + sp_lt_done_int_handler(anx78xx); + + if (sp.tx_system_state > STATE_SINK_CONNECTION) { + if (sp.sp_hdmi_int[5] & SP_NEW_AVI_PKT) + sp_hdmi_new_avi_int(anx78xx); + } + + if (sp.tx_system_state > STATE_VIDEO_OUTPUT) { + if (sp.sp_hdmi_int[6] & SP_NEW_VS) { + sp.sp_hdmi_int[6] &= ~SP_NO_VSI; + sp_hdmi_new_vsi_int(anx78xx); + } + if (sp.sp_hdmi_int[6] & SP_NO_VSI) + sp_hdmi_no_vsi_int(anx78xx); + } + + if (sp.tx_system_state >= STATE_VIDEO_OUTPUT) { + if (sp.sp_hdmi_int[0] & SP_CKDT_CHG) + sp_hdmi_clk_det_int(anx78xx); + + if (sp.sp_hdmi_int[0] & SP_SCDT_CHG) + dev_dbg(dev, "HDCP Sync Detected\n"); + + if (sp.sp_hdmi_int[0] & SP_HDMI_DVI) + sp_hdmi_dvi_int(anx78xx); + + if ((sp.sp_hdmi_int[5] & SP_NEW_AUD_PKT) || + (sp.sp_hdmi_int[2] & SP_AUD_MODE_CHG)) + sp_hdmi_restart_audio_chk(anx78xx); + + if (sp.sp_hdmi_int[5] & SP_CTS_RCV) + sp_hdmi_cts_rcv_int(anx78xx); + + if (sp.sp_hdmi_int[4] & SP_AUDIO_RCV) + sp_hdmi_audio_rcv_int(anx78xx); + + if (sp.sp_hdmi_int[1] & SP_HDCP_ERR) + sp_hdmi_hdcp_error_int(anx78xx); + + if (sp.sp_hdmi_int[5] & SP_NEW_CP_PKT) + sp_hdmi_new_gcp_int(anx78xx); + + if (sp.sp_hdmi_int[1] & SP_AUDIO_SAMPLE_CHG) + sp_hdmi_audio_samplechg_int(anx78xx); + } +} + +static void sp_show_information(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + u8 val, val1; + u16 h_res, h_act, v_res, v_act; + u16 h_fp, h_sw, h_bp, v_fp, v_sw, v_bp; + unsigned long refresh; + unsigned long pclk; + + dev_dbg(dev, "\n************* SP Video Information **************\n"); + + switch (sp_get_link_bw(anx78xx)) { + case SP_LINK_1P62G: + dev_dbg(dev, "BW = 1.62G\n"); + break; + case SP_LINK_2P7G: + dev_dbg(dev, "BW = 2.7G\n"); + break; + case SP_LINK_5P4G: + dev_dbg(dev, "BW = 5.4G\n"); + break; + case SP_LINK_6P75G: + dev_dbg(dev, "BW = 6.75G\n"); + break; + default: + break; + } + + pclk = sp_pclk_calc(anx78xx); + pclk = pclk / 10; + + sp_reg_read(anx78xx, TX_P2, SP_TOTAL_LINE_STAL_REG, &val); + sp_reg_read(anx78xx, TX_P2, SP_TOTAL_LINE_STAH_REG, &val1); + + v_res = val1; + v_res = v_res << 8; + v_res = v_res + val; + + sp_reg_read(anx78xx, TX_P2, SP_ACT_LINE_STAL_REG, &val); + sp_reg_read(anx78xx, TX_P2, SP_ACT_LINE_STAH_REG, &val1); + + v_act = val1; + v_act = v_act << 8; + v_act = v_act + val; + + sp_reg_read(anx78xx, TX_P2, SP_TOTAL_PIXEL_STAL_REG, &val); + sp_reg_read(anx78xx, TX_P2, SP_TOTAL_PIXEL_STAH_REG, &val1); + + h_res = val1; + h_res = h_res << 8; + h_res = h_res + val; + + sp_reg_read(anx78xx, TX_P2, SP_ACT_PIXEL_STAL_REG, &val); + sp_reg_read(anx78xx, TX_P2, SP_ACT_PIXEL_STAH_REG, &val1); + + h_act = val1; + h_act = h_act << 8; + h_act = h_act + val; + + sp_reg_read(anx78xx, TX_P2, SP_H_F_PORCH_STAL_REG, &val); + sp_reg_read(anx78xx, TX_P2, SP_H_F_PORCH_STAH_REG, &val1); + + h_fp = val1; + h_fp = h_fp << 8; + h_fp = h_fp + val; + + sp_reg_read(anx78xx, TX_P2, SP_H_SYNC_STAL_REG, &val); + sp_reg_read(anx78xx, TX_P2, SP_H_SYNC_STAH_REG, &val1); + + h_sw = val1; + h_sw = h_sw << 8; + h_sw = h_sw + val; + + sp_reg_read(anx78xx, TX_P2, SP_H_B_PORCH_STAL_REG, &val); + sp_reg_read(anx78xx, TX_P2, SP_H_B_PORCH_STAH_REG, &val1); + + h_bp = val1; + h_bp = h_bp << 8; + h_bp = h_bp + val; + + sp_reg_read(anx78xx, TX_P2, SP_V_F_PORCH_STA_REG, &val); + v_fp = val; + + sp_reg_read(anx78xx, TX_P2, SP_V_SYNC_STA_REG, &val); + v_sw = val; + + sp_reg_read(anx78xx, TX_P2, SP_V_B_PORCH_STA_REG, &val); + v_bp = val; + + dev_dbg(dev, "Total resolution is %d * %d\n", h_res, v_res); + + dev_dbg(dev, "HF=%d, HSW=%d, HBP=%d\n", h_fp, h_sw, h_bp); + dev_dbg(dev, "VF=%d, VSW=%d, VBP=%d\n", v_fp, v_sw, v_bp); + + if (h_res == 0 || v_res == 0) { + refresh = 0; + } else { + refresh = pclk * 1000; + refresh = refresh / h_res; + refresh = refresh * 1000; + refresh = refresh / v_res; + } + + dev_dbg(dev, "Active resolution is %d * %d @ %ldHz\n", h_act, v_act, + refresh); + + sp_reg_read(anx78xx, TX_P0, SP_DP_VIDEO_CTRL_REG, &val); + + val &= SP_COLOR_F_MASK; + val >>= SP_COLOR_F_SHIFT; + if (val == SP_COLORSPACE_RGB) + dev_dbg(dev, "ColorSpace: RGB"); + else if (val == SP_COLORSPACE_YCBCR422) + dev_dbg(dev, "ColorSpace: YCbCr422"); + else if (val == SP_COLORSPACE_YCBCR444) + dev_dbg(dev, "ColorSpace: YCbCr444"); + + sp_reg_read(anx78xx, TX_P0, SP_DP_VIDEO_CTRL_REG, &val); + + val &= SP_BPC_MASK; + val >>= SP_BPC_SHIFT; + if (val == SP_BPC_6BITS) + dev_dbg(dev, "6 BPC\n"); + else if (val == SP_BPC_8BITS) + dev_dbg(dev, "8 BPC\n"); + else if (val == SP_BPC_10BITS) + dev_dbg(dev, "10 BPC\n"); + else if (val == SP_BPC_12BITS) + dev_dbg(dev, "12 BPC\n"); + + if (is_anx_dongle(anx78xx)) { + sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x05, 0x23, 1, &val); + dev_dbg(dev, "Analogix Dongle FW Ver %.2x\n", val & 0x7f); + } + + dev_dbg(dev, "\n**************************************************\n"); +} + +static void sp_aux_monitor(struct anx78xx *anx78xx) +{ + int i; + u8 val; + + for (i = 0; i < 5; i++) { + if (sp_aux_dpcdread_bytes(anx78xx, 0x00, 0x00, 0x00, + 1, &val) < 0) { + anx78xx_poweroff(anx78xx); + sp_set_system_state(anx78xx, STATE_WAITING_CABLE_PLUG); + } else { + return; + } + } +} + +static void sp_hdcp_repeater_reauth(struct anx78xx *anx78xx) +{ + u8 val, ctrl, status; + struct device *dev = &anx78xx->client->dev; + + msleep(50); + sp_reg_read(anx78xx, RX_P1, SP_RX_HDCP_STATUS_REG, &val); + + if (val & SP_AUTH_EN) { + sp_reg_read(anx78xx, TX_P0, SP_HDCP_CTRL0_REG, &ctrl); + if (ctrl & SP_HARD_AUTH_EN) { + sp_reg_read(anx78xx, TX_P0, SP_TX_HDCP_STATUS_REG, + &status); + if (!(status & SP_AUTHEN_PASS) && + (status & SP_AUTH_FAIL)) { + dev_dbg(dev, "clean HDCP and re-auth\n"); + sp.repeater_state = HDCP_ERROR; + } + } else { + dev_dbg(dev, "repeater mode, enable HW HDCP\n"); + sp.repeater_state = HDCP_ERROR; + } + } + + sp_reg_read(anx78xx, TX_P0, SP_HDCP_CTRL0_REG, &ctrl); + sp_reg_read(anx78xx, TX_P0, SP_TX_HDCP_STATUS_REG, &status); + + if ((ctrl == SP_HDCP_FUNCTION_ENABLED) && (status & SP_AUTH_FAIL)) { + dev_dbg(dev, "HDCP encryption failure 0x%02x\n", status); + sp.repeater_state = HDCP_ERROR; + } + + if (sp.repeater_state == HDCP_ERROR) { + sp_clean_hdcp_status(anx78xx); + msleep(50); + /* Clear HDCP AUTH interrupt */ + sp_reg_set_bits(anx78xx, TX_P2, SP_COMMON_INT_STATUS_BASE + 2, + SP_HDCP_AUTH_DONE); + sp_hw_hdcp_enable(anx78xx); + sp.repeater_state = HDCP_DOING; + } +} + +static void sp_task_handler(struct anx78xx *anx78xx) +{ + sp_aux_monitor(anx78xx); + + if (sp.tx_system_state > STATE_WAITING_CABLE_PLUG) + sp_system_isr_handler(anx78xx); + + /* If device supports HDCP repeater function re-auth */ + if (sp_hdcp_repeater_mode(anx78xx)) + sp_hdcp_repeater_reauth(anx78xx); +} + +/******************End task process********************/ + +/** + * sp_main_process(): SlimPort Main Process + * + * SlimPort Main Process States: + * 1. SlimPort plug + * - If a SlimPort cable plug is detected: + * - Power on device + * - If a SlimPort cable plug is not detected: + * - Power down device + * 2. SlimPort initialization + * - Enable the power supply for downstream + * - Power on the register access + * - Initialize the related registers + * 3. Sink connection + * - Get the cable type (HDMI, VGA or MyDP) + * - Check the connection with downstream + * 4. Read EDID + * - Read partial EDID data to decide whether to re-read entire EDID + * - EDID read + * - Parse EDID to get the video bandwidth + * 5. Link training + * - Check the downstream bandwidth + * - Hardware link training + * 6. Video output + * - Verify that input video is stable + * - Order by the input video to calculate the bandwidth + * - Set AVI packet, bit-mapping, color depth, etc. + * 7. HDCP authentication + * - Verify that HDCP is supported + * - Enable hardware HDCP + * 8. Audio output + * - Automatic audio M valu adjustment + * - Configure audio multichannel + * - Set audio packet + * 9. Playback + * - The normal system working state + * + */ +bool sp_main_process(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + + /* + * SlimPort State Process + */ + switch (sp.tx_system_state) { + case STATE_WAITING_CABLE_PLUG: + sp_variable_init(); + if (anx78xx_cable_is_detected(anx78xx)) { + anx78xx_poweron(anx78xx); + sp.tx_system_state = STATE_SP_INITIALIZED; + dev_dbg(dev, ">> System State Transition\n"); + sp_print_system_state(anx78xx, sp.tx_system_state); + } else { + anx78xx_poweroff(anx78xx); + return false; + } + /* fallthrough */ + case STATE_SP_INITIALIZED: + sp_initialization(anx78xx); + sp.tx_system_state = STATE_SINK_CONNECTION; + dev_dbg(dev, ">> System State Transition\n"); + sp_print_system_state(anx78xx, sp.tx_system_state); + /* fallthrough */ + case STATE_SINK_CONNECTION: + if (sp_get_dp_connection(anx78xx)) { + sp.tx_system_state = STATE_PARSE_EDID; + dev_dbg(dev, ">> System State Transition\n"); + sp_print_system_state(anx78xx, sp.tx_system_state); + } else { + break; + } + /* fallthrough */ + case STATE_PARSE_EDID: + if (sp_edid_process(anx78xx)) { + sp.tx_system_state = STATE_LINK_TRAINING; + dev_dbg(dev, ">> System State Transition\n"); + sp_print_system_state(anx78xx, sp.tx_system_state); + } else { + break; + } + /* fallthrough */ + case STATE_LINK_TRAINING: + if (sp_link_training(anx78xx)) { + sp.tx_system_state = STATE_VIDEO_OUTPUT; + dev_dbg(dev, ">> System State Transition\n"); + sp_print_system_state(anx78xx, sp.tx_system_state); + } else { + break; + } + /* fallthrough */ + case STATE_VIDEO_OUTPUT: + if (sp_config_video_output(anx78xx)) { + sp.tx_system_state = STATE_HDCP_AUTH; + dev_dbg(dev, ">> System State Transition\n"); + sp_print_system_state(anx78xx, sp.tx_system_state); + } else { + break; + } + /* fallthrough */ + case STATE_HDCP_AUTH: + if (!sp_hdcp_repeater_mode(anx78xx)) { + if (sp_hdcp_process(anx78xx)) { + sp.tx_system_state = STATE_AUDIO_OUTPUT; + dev_dbg(dev, ">> System State Transition\n"); + sp_print_system_state(anx78xx, + sp.tx_system_state); + } else { + break; + } + } else { + sp.tx_system_state = STATE_AUDIO_OUTPUT; + } + /* fallthrough */ + case STATE_AUDIO_OUTPUT: + if (sp_config_audio_output(anx78xx)) { + sp.tx_system_state = STATE_PLAY_BACK; + dev_dbg(dev, ">> System State Transition\n"); + sp_print_system_state(anx78xx, sp.tx_system_state); + } else { + break; + } + /* fallthrough */ + case STATE_PLAY_BACK: + default: + break; + } + + /* Process the interrupts */ + if (sp.tx_system_state > STATE_WAITING_CABLE_PLUG) { + /* + * Interrupt receiver + */ + sp_int_receiver(anx78xx); + + /* + * Task handler + */ + sp_task_handler(anx78xx); + } + + return true; +} + +/** + * sp_system_init(): System initialization + * + * @anx78xx: SlimPort device. + * + * A value of zero will be returned on success, a negative errno will + * be returned in error cases. + */ +int sp_system_init(struct anx78xx *anx78xx) +{ + struct device *dev = &anx78xx->client->dev; + u16 id; + u8 idh = 0, idl = 0; + int i; + + anx78xx_poweron(anx78xx); + + /* check chip id */ + sp_reg_read(anx78xx, TX_P2, SP_DEVICE_IDL_REG, &idl); + sp_reg_read(anx78xx, TX_P2, SP_DEVICE_IDH_REG, &idh); + id = idl | (idh << 8); + + for (i = 0; i < ARRAY_SIZE(chipid_list); i++) { + if (id == chipid_list[i]) { + sp_variable_init(); + return 0; + } + } + + anx78xx_poweroff(anx78xx); + + dev_err(dev, "failed to detect ANX%x\n", id); + + return -ENODEV; +} diff --git a/drivers/gpu/drm/bridge/anx78xx/slimport_tx_drv.h b/drivers/gpu/drm/bridge/anx78xx/slimport_tx_drv.h new file mode 100644 index 0000000..6eee698 --- /dev/null +++ b/drivers/gpu/drm/bridge/anx78xx/slimport_tx_drv.h @@ -0,0 +1,149 @@ +/* + * Copyright(c) 2015, Analogix Semiconductor. All rights reserved. + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 and + * only version 2 as published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + */ + +#ifndef __SLIMPORT_TX_DRV_H +#define __SLIMPORT_TX_DRV_H + +#include + +#include "anx78xx.h" +#include "slimport_tx_reg.h" + +#define FW_VERSION 0x23 + +#define HDMI_INFOFRAME_TYPE_MPEG 0x85 +#define HDMI_MPEG_INFOFRAME_SIZE 10 +#define HDMI_VSI_INFOFRAME_SIZE 10 + +enum sp_tx_state { + STATE_WAITING_CABLE_PLUG, + STATE_SP_INITIALIZED, + STATE_SINK_CONNECTION, + STATE_PARSE_EDID, + STATE_LINK_TRAINING, + STATE_VIDEO_OUTPUT, + STATE_HDCP_AUTH, + STATE_AUDIO_OUTPUT, + STATE_PLAY_BACK +}; + +enum sp_tx_power_block { + SP_TX_PWR_REG = SP_REGISTER_PD, + SP_TX_PWR_HDCP = SP_HDCP_PD, + SP_TX_PWR_AUDIO = SP_AUDIO_PD, + SP_TX_PWR_VIDEO = SP_VIDEO_PD, + SP_TX_PWR_LINK = SP_LINK_PD, + SP_TX_PWR_TOTAL = SP_TOTAL_PD, + SP_TX_PWR_NUMS +}; + +enum hdmi_color_depth { + HDMI_LEGACY = 0x00, + HDMI_24BIT = 0x04, + HDMI_30BIT = 0x05, + HDMI_36BIT = 0x06, + HDMI_48BIT = 0x07, +}; + +enum sp_tx_lt_status { + LT_INIT, + LT_WAIT_PLL_LOCK, + LT_CHECK_LINK_BW, + LT_START, + LT_WAITING_FINISH, + LT_ERROR, + LT_FINISH, +}; + +enum hdcp_status { + HDCP_CAPABLE_CHECK, + HDCP_WAITING_VID_STB, + HDCP_HW_ENABLE, + HDCP_WAITING_FINISH, + HDCP_FINISH, + HDCP_FAILED, + HDCP_NOT_SUPPORTED, +}; + +enum repeater_status { + HDCP_DONE, + HDCP_DOING, + HDCP_ERROR, +}; + +enum video_output_status { + VO_WAIT_VIDEO_STABLE, + VO_WAIT_TX_VIDEO_STABLE, + VO_CHECK_VIDEO_INFO, + VO_FINISH, +}; + +enum audio_output_status { + AO_INIT, + AO_CTS_RCV_INT, + AO_AUDIO_RCV_INT, + AO_RCV_INT_FINISH, + AO_OUTPUT, +}; + +struct packet_audio { + struct hdmi_any_infoframe infoframe; + u8 data[HDMI_AUDIO_INFOFRAME_SIZE]; +}; + +struct packet_avi { + struct hdmi_any_infoframe infoframe; + u8 data[HDMI_AVI_INFOFRAME_SIZE]; +}; + +struct packet_mpeg { + struct hdmi_any_infoframe infoframe; + u8 data[HDMI_MPEG_INFOFRAME_SIZE]; +}; + +struct packet_vsi { + struct hdmi_any_infoframe infoframe; + u8 data[HDMI_VSI_INFOFRAME_SIZE]; +}; + +enum packets_type { + AVI_PACKETS, + MPEG_PACKETS, + VSI_PACKETS, + AUDIF_PACKETS +}; + +enum sp_ssc_dep { + SSC_DEP_DISABLE = 0x0, + SSC_DEP_500PPM, + SSC_DEP_1000PPM, + SSC_DEP_1500PPM, + SSC_DEP_2000PPM, + SSC_DEP_2500PPM, + SSC_DEP_3000PPM, + SSC_DEP_3500PPM, + SSC_DEP_4000PPM, + SSC_DEP_4500PPM, + SSC_DEP_5000PPM, + SSC_DEP_5500PPM, + SSC_DEP_6000PPM +}; + +bool sp_main_process(struct anx78xx *anx78xx); + +int sp_system_init(struct anx78xx *anx78xx); + +u8 sp_get_link_bandwidth(struct anx78xx *anx78xx); + +#endif diff --git a/drivers/gpu/drm/bridge/anx78xx/slimport_tx_reg.h b/drivers/gpu/drm/bridge/anx78xx/slimport_tx_reg.h new file mode 100644 index 0000000..2110f84 --- /dev/null +++ b/drivers/gpu/drm/bridge/anx78xx/slimport_tx_reg.h @@ -0,0 +1,754 @@ +/* + * Copyright(c) 2015, Analogix Semiconductor. All rights reserved. + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 and + * only version 2 as published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + */ + +#ifndef __SLIMPORT_TX_REG_DEF_H +#define __SLIMPORT_TX_REG_DEF_H + +#define TX_P0 0x70 +#define TX_P1 0x7a +#define TX_P2 0x72 + +#define RX_P0 0x7e +#define RX_P1 0x80 + +/***************************************************************/ +/* Register definition of device address 0x7e */ +/***************************************************************/ + +/* + * System Control and Status + */ + +/* Software Reset Register 1 */ +#define SP_SOFTWARE_RESET1_REG 0x11 +#define SP_VIDEO_RST BIT(4) +#define SP_HDCP_MAN_RST BIT(2) +#define SP_TMDS_RST BIT(1) +#define SP_SW_MAN_RST BIT(0) + +/* System Status Register */ +#define SP_SYSTEM_STATUS_REG 0x14 +#define SP_TMDS_CLOCK_DET BIT(1) +#define SP_TMDS_DE_DET BIT(0) + +/* HDMI Status Register */ +#define SP_HDMI_STATUS_REG 0x15 +#define SP_HDMI_AUD_LAYOUT BIT(3) +#define SP_HDMI_DET BIT(0) +# define SP_DVI_MODE 0 +# define SP_HDMI_MODE 1 + +/* HDMI Mute Control Register */ +#define SP_HDMI_MUTE_CTRL_REG 0x16 +#define SP_AUD_MUTE BIT(1) +#define SP_VID_MUTE BIT(0) + +/* System Power Down Register 1 */ +#define SP_SYSTEM_POWER_DOWN1_REG 0x18 +#define SP_PWDN_CTRL BIT(0) + +/* + * Audio and Video Auto Control + */ + +/* Auto Audio and Video Control register */ +#define SP_AUDVID_CTRL_REG 0x20 +#define SP_AVC_OE BIT(7) +#define SP_AAC_OE BIT(6) +#define SP_AVC_EN BIT(1) +#define SP_AAC_EN BIT(0) + +/* Audio Exception Enable Registers */ +#define SP_AUD_EXCEPTION_ENABLE_BASE (0x24 - 1) +/* Bits for Audio Exception Enable Register 3 */ +#define SP_AEC_EN21 BIT(5) + +/* + * Interrupt + */ + +/* Interrupt Status Register 1 */ +#define SP_INT_STATUS1_REG 0x31 +/* Bits for Interrupt Status Register 1 */ +#define SP_HDMI_DVI BIT(7) +#define SP_CKDT_CHG BIT(6) +#define SP_SCDT_CHG BIT(5) +#define SP_PCLK_CHG BIT(4) +#define SP_PLL_UNLOCK BIT(3) +#define SP_CABLE_PLUG_CHG BIT(2) +#define SP_SET_MUTE BIT(1) +#define SP_SW_INTR BIT(0) +/* Bits for Interrupt Status Register 2 */ +#define SP_HDCP_ERR BIT(5) +#define SP_AUDIO_SAMPLE_CHG BIT(0) /* undocumented */ +/* Bits for Interrupt Status Register 3 */ +#define SP_AUD_MODE_CHG BIT(0) +/* Bits for Interrupt Status Register 5 */ +#define SP_AUDIO_RCV BIT(0) +/* Bits for Interrupt Status Register 6 */ +#define SP_CTS_RCV BIT(7) +#define SP_NEW_AUD_PKT BIT(4) +#define SP_NEW_AVI_PKT BIT(1) +#define SP_NEW_CP_PKT BIT(0) +/* Bits for Interrupt Status Register 7 */ +#define SP_NO_VSI BIT(7) +#define SP_NEW_VS BIT(4) + +/* Interrupt Mask Status Registers */ +#define SP_INT_MASK_BASE (0x41 - 1) + +/* HDMI US TIMER Control Register */ +#define SP_HDMI_US_TIMER_CTRL_REG 0x49 +#define SP_MS_TIMER_MARGIN_10_8_MASK 0x07 + +/* + * TMDS Control + */ + +/* TMDS Control Registers */ +#define SP_TMDS_CTRL_BASE (0x50 - 1) +/* Bits for TMDS Control Register 7 */ +#define SP_PD_RT BIT(0) + +/* + * Video Control + */ + +/* Video Status Register */ +#define SP_VIDEO_STATUS_REG 0x70 +#define SP_COLOR_DEPTH_MASK 0xf0 +#define SP_COLOR_DEPTH_SHIFT 4 + +/* Video Data Range Control Register */ +#define SP_VID_DATA_RANGE_CTRL_REG 0x83 +#define SP_R2Y_INPUT_LIMIT BIT(1) + +/* Pixel Clock High Resolution Counter Registers */ +#define SP_PCLK_HIGHRES_CNT_BASE (0x8c - 1) + +/* + * Audio Control + */ + +/* Number of Audio Channels Status Registers */ +#define SP_AUD_CH_STATUS_REG_NUM 5 + +/* Audio IN S/PDIF Channel Status Registers */ +#define SP_AUD_SPDIF_CH_STATUS_BASE 0xc7 + +/* Audio IN S/PDIF Channel Status Register 4 */ +#define SP_FS_FREQ_MASK 0x0f +# define SP_FS_FREQ_44100HZ 0x00 +# define SP_FS_FREQ_48000HZ 0x02 +# define SP_FS_FREQ_32000HZ 0x03 +# define SP_FS_FREQ_88200HZ 0x08 +# define SP_FS_FREQ_96000HZ 0x0a +# define SP_FS_FREQ_176400HZ 0x0c +# define SP_FS_FREQ_192000HZ 0x0e + +/* + * Micellaneous Control Block + */ + +/* CHIP Control Register */ +#define SP_CHIP_CTRL_REG 0xe3 +#define SP_MAN_HDMI5V_DET BIT(3) +#define SP_PLLLOCK_CKDT_EN BIT(2) +#define SP_ANALOG_CKDT_EN BIT(1) +#define SP_DIGITAL_CKDT_EN BIT(0) + +/* Packet Receiving Status Register */ +#define SP_PACKET_RECEIVING_STATUS_REG 0xf3 +#define SP_AVI_RCVD BIT(5) +#define SP_VSI_RCVD BIT(1) + +/***************************************************************/ +/* Register definition of device address 0x80 */ +/***************************************************************/ + +/* HDCP BCAPS Shadow Register */ +#define SP_HDCP_BCAPS_SHADOW_REG 0x2a +#define SP_BCAPS_REPEATER BIT(5) + +/* HDCP Status Register */ +#define SP_RX_HDCP_STATUS_REG 0x3f +#define SP_AUTH_EN BIT(4) + +/* + * InfoFrame and Control Packet Registers + */ + +#define SP_COLORSPACE_RGB 0x00 +#define SP_COLORSPACE_YCBCR422 0x01 +#define SP_COLORSPACE_YCBCR444 0x02 + +/* AVI InfoFrame Registers */ +#define SP_AVI_INFOFRAME_DATA_BASE 0xa4 + +#define SP_AVI_COLOR_F_MASK 0x60 +#define SP_AVI_COLOR_F_SHIFT 5 + +/* Audio InfoFrame Registers */ +#define SP_AUD_INFOFRAME_DATA_BASE 0xc4 +#define SP_AUD_INFOFRAME_LAYOUT_MASK 0x0f + +/* MPEG/HDMI Vendor Specific InfoFrame Packet type code */ +#define SP_MPEG_VS_INFOFRAME_TYPE_REG 0xe0 + +/* MPEG/HDMI Vendor Specific InfoFrame Packet version number */ +#define SP_MPEG_VS_INFOFRAME_VER_REG 0xe1 + +/* MPEG/HDMI Vendor Specific InfoFrame Packet content */ +#define SP_MPEG_VS_INFOFRAME_DATA_BASE 0xe4 + +/* General Control Packet Register */ +#define SP_GENERAL_CTRL_PACKET_REG 0x9f +#define SP_CLEAR_AVMUTE BIT(4) +#define SP_SET_AVMUTE BIT(0) + +/***************************************************************/ +/* Register definition of device address 0x70 */ +/***************************************************************/ + +/* HDCP Status Register */ +#define SP_TX_HDCP_STATUS_REG 0x00 +#define SP_AUTH_FAIL BIT(5) +#define SP_AUTHEN_PASS BIT(1) + +/* HDCP Control Register 0 */ +#define SP_HDCP_CTRL0_REG 0x01 +#define SP_RX_REPEATER BIT(6) +#define SP_RE_AUTH BIT(5) +#define SP_SW_AUTH_OK BIT(4) +#define SP_HARD_AUTH_EN BIT(3) +#define SP_HDCP_ENC_EN BIT(2) +#define SP_BKSV_SRM_PASS BIT(1) +#define SP_KSVLIST_VLD BIT(0) +/* HDCP Function Enabled */ +#define SP_HDCP_FUNCTION_ENABLED (BIT(0) | BIT(1) | BIT(2) | BIT(3)) + +/* HDCP Receiver BSTATUS Register 0 */ +#define SP_HDCP_RX_BSTATUS0_REG 0x1b +/* HDCP Receiver BSTATUS Register 1 */ +#define SP_HDCP_RX_BSTATUS1_REG 0x1c + +/* HDCP Embedded "Blue Screen" Content Registers */ +#define SP_HDCP_VID0_BLUE_SCREEN_REG 0x2c +#define SP_HDCP_VID1_BLUE_SCREEN_REG 0x2d +#define SP_HDCP_VID2_BLUE_SCREEN_REG 0x2e + +/* HDCP Wait R0 Timing Register */ +#define SP_HDCP_WAIT_R0_TIME_REG 0x40 + +/* HDCP Link Integrity Check Timer Register */ +#define SP_HDCP_LINK_CHECK_TIMER_REG 0x41 + +/* HDCP Repeater Ready Wait Timer Register */ +#define SP_HDCP_RPTR_RDY_WAIT_TIME_REG 0x42 + +/* HDCP Auto Timer Register */ +#define SP_HDCP_AUTO_TIMER_REG 0x51 + +/* HDCP Key Status Register */ +#define SP_HDCP_KEY_STATUS_REG 0x5e + +/* HDCP Key Command Register */ +#define SP_HDCP_KEY_COMMAND_REG 0x5f +#define SP_DISABLE_SYNC_HDCP BIT(2) + +/* OTP Memory Key Protection Registers */ +#define SP_OTP_KEY_PROTECT1_REG 0x60 +#define SP_OTP_KEY_PROTECT2_REG 0x61 +#define SP_OTP_KEY_PROTECT3_REG 0x62 +#define SP_OTP_PSW1 0xa2 +#define SP_OTP_PSW2 0x7e +#define SP_OTP_PSW3 0xc6 + +/* DP System Control Registers */ +#define SP_DP_SYSTEM_CTRL_BASE (0x80 - 1) +/* Bits for DP System Control Register 2 */ +#define SP_CHA_STA BIT(2) +/* Bits for DP System Control Register 3 */ +#define SP_HPD_STATUS BIT(6) +#define SP_STRM_VALID BIT(2) +/* Bits for DP System Control Register 4 */ +#define SP_ENHANCED_MODE BIT(3) + +/* DP Video Control Register */ +#define SP_DP_VIDEO_CTRL_REG 0x84 +#define SP_COLOR_F_MASK 0x06 +#define SP_COLOR_F_SHIFT 1 +#define SP_BPC_MASK 0xe0 +#define SP_BPC_SHIFT 5 +# define SP_BPC_6BITS 0x00 +# define SP_BPC_8BITS 0x01 +# define SP_BPC_10BITS 0x02 +# define SP_BPC_12BITS 0x03 + +/* DP Audio Control Register */ +#define SP_DP_AUDIO_CTRL_REG 0x87 +#define SP_AUD_EN BIT(0) + +/* 10us Pulse Generate Timer Registers */ +#define SP_I2C_GEN_10US_TIMER0_REG 0x88 +#define SP_I2C_GEN_10US_TIMER1_REG 0x89 + +/* Packet Send Control Register */ +#define SP_PACKET_SEND_CTRL_REG 0x90 +#define SP_AUD_IF_UP BIT(7) +#define SP_AVI_IF_UD BIT(6) +#define SP_MPEG_IF_UD BIT(5) +#define SP_SPD_IF_UD BIT(4) +#define SP_AUD_IF_EN BIT(3) +#define SP_AVI_IF_EN BIT(2) +#define SP_MPEG_IF_EN BIT(1) +#define SP_SPD_IF_EN BIT(0) + +/* DP HDCP Control Register */ +#define SP_DP_HDCP_CTRL_REG 0x92 +#define SP_AUTO_EN BIT(7) +#define SP_AUTO_START BIT(5) +#define SP_LINK_POLLING BIT(1) + +/* DP Main Link Bandwidth Setting Register */ +#define SP_DP_MAIN_LINK_BW_SET_REG 0xa0 +#define SP_LINK_BW_SET_MASK 0x1f +# define SP_LINK_6P75G 0x19 +# define SP_LINK_5P4G 0x14 +# define SP_LINK_2P7G 0x0a +# define SP_LINK_1P62G 0x06 +#define SP_INITIAL_SLIM_M_AUD_SEL BIT(5) + +/* DP Training Pattern Set Register */ +#define SP_DP_TRAINING_PATTERN_SET_REG 0xa2 + +/* DP Lane 0 Link Training Control Register */ +#define SP_DP_LANE0_LT_CTRL_REG 0xa3 +#define SP_TX_SW_SET_MASK 0x1b +#define SP_MAX_PRE_REACH BIT(5) +#define SP_MAX_DRIVE_REACH BIT(4) +#define SP_PRE_EMP_LEVEL1 BIT(3) +#define SP_DRVIE_CURRENT_LEVEL1 BIT(0) + +/* DP Link Training Control Register */ +#define SP_DP_LT_CTRL_REG 0xa8 +#define SP_LT_ERROR_TYPE_MASK 0x70 +# define SP_LT_NO_ERROR 0x00 +# define SP_LT_AUX_WRITE_ERROR 0x01 +# define SP_LT_MAX_DRIVE_REACHED 0x02 +# define SP_LT_WRONG_LANE_COUNT_SET 0x03 +# define SP_LT_LOOP_SAME_5_TIME 0x04 +# define SP_LT_CR_FAIL_IN_EQ 0x05 +# define SP_LT_EQ_LOOP_5_TIME 0x06 +#define SP_LT_EN BIT(0) + +/* DP CEP Training Control Registers */ +#define SP_DP_CEP_TRAINING_CTRL0_REG 0xa9 +#define SP_DP_CEP_TRAINING_CTRL1_REG 0xaa + +/* DP Debug Register 1 */ +#define SP_DP_DEBUG1_REG 0xb0 +#define SP_DEBUG_PLL_LOCK BIT(4) +#define SP_POLLING_EN BIT(1) + +/* DP Polling Control Register */ +#define SP_DP_POLLING_CTRL_REG 0xb4 +#define SP_AUTO_POLLING_DISABLE BIT(0) + +/* DP Link Debug Control Register */ +#define SP_DP_LINK_DEBUG_CTRL_REG 0xb8 +#define SP_M_VID_DEBUG BIT(5) +#define SP_NEW_PRBS7 BIT(4) +#define SP_INSERT_ER BIT(1) +#define SP_PRBS31_EN BIT(0) + +/* AUX Misc control Register */ +#define SP_AUX_MISC_CTRL_REG 0xbf + +/* DP PLL control Register */ +#define SP_DP_PLL_CTRL_REG 0xc7 +#define SP_PLL_RST BIT(6) + +/* DP Analog Power Down Register */ +#define SP_DP_ANALOG_POWER_DOWN_REG 0xc8 +#define SP_CH0_PD BIT(0) + +/* DP Misc Control Register */ +#define SP_DP_MISC_CTRL_REG 0xcd +#define SP_EQ_TRAINING_LOOP BIT(6) + +/* DP Extra I2C Device Address Register */ +#define SP_DP_EXTRA_I2C_DEV_ADDR_REG 0xce +#define SP_I2C_STRETCH_DISABLE BIT(7) + +#define SP_I2C_EXTRA_ADDR 0x50 + +/* DP DownSpreading Control Register 1 */ +#define SP_DP_DOWNSPREADING_CTRL1_REG 0xd0 +#define SP_TX_SSC_DISABLE 0xc0 +#define SP_TX_SSC_DOWNSPREADING BIT(6) + +/* DP M Value Calculation Control Register */ +#define SP_DP_M_CALCULATION_CTRL_REG 0xd9 +#define SP_M_GEN_CLK_SEL BIT(0) + +/* AUX Channel Access Status Register */ +#define SP_AUX_CH_STATUS_REG 0xe0 +#define SP_AUX_STATUS 0x0f + +/* AUX Channel DEFER Control Register */ +#define SP_AUX_DEFER_CTRL_REG 0xe2 +#define SP_DEFER_CTRL_EN BIT(7) + +/* DP Buffer Data Count Register */ +#define SP_BUF_DATA_COUNT_REG 0xe4 +#define SP_BUF_CLR BIT(7) + +/* DP AUX Channel Control Register 1 */ +#define SP_DP_AUX_CH_CTRL1_REG 0xe5 +#define SP_AUX_TX_COMM_MASK 0x0f +#define SP_AUX_LENGTH_MASK 0xf0 +#define SP_AUX_LENGTH_SHIFT 4 + +/* DP AUX CH Address Register 0 */ +#define SP_AUX_ADDR_7_0_REG 0xe6 + +/* DP AUX CH Address Register 1 */ +#define SP_AUX_ADDR_15_8_REG 0xe7 + +/* DP AUX CH Address Register 2 */ +#define SP_AUX_ADDR_19_16_REG 0xe8 +#define SP_AUX_ADDR_19_16_MASK 0x0f + +/* DP AUX Channel Control Register 2 */ +#define SP_DP_AUX_CH_CTRL2_REG 0xe9 +#define SP_AUX_SEL_RXCM BIT(6) +#define SP_AUX_CHSEL BIT(3) +#define SP_AUX_PN_INV BIT(2) +#define SP_ADDR_ONLY BIT(1) +#define SP_AUX_EN BIT(0) + +/* DP Video Stream Control InfoFrame Register */ +#define SP_DP_3D_VSC_CTRL_REG 0xea +#define SP_INFO_FRAME_VSC_EN BIT(0) + +/* DP Video Stream Data Byte 1 Register */ +#define SP_DP_VSC_DB1_REG 0xeb + +/* DP AUX Channel Control Register 3 */ +#define SP_DP_AUX_CH_CTRL3_REG 0xec +#define SP_WAIT_COUNTER_7_0_MASK 0xff + +/* DP AUX Channel Control Register 4 */ +#define SP_DP_AUX_CH_CTRL4_REG 0xed + +/* DP AUX Buffer Data Registers */ +#define SP_DP_BUF_DATA0_REG 0xf0 + +/***************************************************************/ +/* Register definition of device address 0x72 */ +/***************************************************************/ + +/* + * Core Register Definitions + */ + +/* Device ID Low Byte Register */ +#define SP_DEVICE_IDL_REG 0x02 + +/* Device ID High Byte Register */ +#define SP_DEVICE_IDH_REG 0x03 + +/* Power Down Control Register */ +#define SP_POWERDOWN_CTRL_REG 0x05 +#define SP_REGISTER_PD BIT(7) +#define SP_HDCP_PD BIT(5) +#define SP_AUDIO_PD BIT(4) +#define SP_VIDEO_PD BIT(3) +#define SP_LINK_PD BIT(2) +#define SP_TOTAL_PD BIT(1) + +/* Reset Control Register 1 */ +#define SP_RESET_CTRL1_REG 0x06 +#define SP_MISC_RST BIT(7) +#define SP_VIDCAP_RST BIT(6) +#define SP_VIDFIF_RST BIT(5) +#define SP_AUDFIF_RST BIT(4) +#define SP_AUDCAP_RST BIT(3) +#define SP_HDCP_RST BIT(2) +#define SP_SW_RST BIT(1) +#define SP_HW_RST BIT(0) + +/* Reset Control Register 2 */ +#define SP_RESET_CTRL2_REG 0x07 +#define SP_AUX_RST BIT(2) +#define SP_SERDES_FIFO_RST BIT(1) +#define SP_I2C_REG_RST BIT(0) + +/* Video Control Register 1 */ +#define SP_VID_CTRL1_REG 0x08 +#define SP_VIDEO_EN BIT(7) +#define SP_VIDEO_MUTE BIT(2) +#define SP_DE_GEN BIT(1) +#define SP_DEMUX BIT(0) + +/* Video Control Register 2 */ +#define SP_VID_CTRL2_REG 0x09 +#define SP_IN_COLOR_F_MASK 0x03 +#define SP_IN_YC_BIT_SEL BIT(2) +#define SP_IN_BPC_MASK 0x70 +#define SP_IN_BPC_SHIFT 4 +# define SP_IN_BPC_12BIT 0x03 +# define SP_IN_BPC_10BIT 0x02 +# define SP_IN_BPC_8BIT 0x01 +# define SP_IN_BPC_6BIT 0x00 +#define SP_IN_D_RANGE BIT(7) + +/* Video Control Register 3 */ +#define SP_VID_CTRL3_REG 0x0a +#define SP_HPD_OUT BIT(6) + +/* Video Control Register 5 */ +#define SP_VID_CTRL5_REG 0x0c +#define SP_CSC_STD_SEL BIT(7) +#define SP_XVYCC_RNG_LMT BIT(6) +#define SP_RANGE_Y2R BIT(5) +#define SP_CSPACE_Y2R BIT(4) +#define SP_RGB_RNG_LMT BIT(3) +#define SP_Y_RNG_LMT BIT(2) +#define SP_RANGE_R2Y BIT(1) +#define SP_CSPACE_R2Y BIT(0) + +/* Video Control Register 6 */ +#define SP_VID_CTRL6_REG 0x0d +#define SP_TEST_PATTERN_EN BIT(7) +#define SP_VIDEO_PROCESS_EN BIT(6) +#define SP_VID_US_MODE BIT(3) +#define SP_VID_DS_MODE BIT(2) +#define SP_UP_SAMPLE BIT(1) +#define SP_DOWN_SAMPLE BIT(0) + +/* Video Control Register 8 */ +#define SP_VID_CTRL8_REG 0x0f +#define SP_VID_VRES_TH BIT(0) + +/* Total Line Status Low Byte Register */ +#define SP_TOTAL_LINE_STAL_REG 0x24 + +/* Total Line Status High Byte Register */ +#define SP_TOTAL_LINE_STAH_REG 0x25 + +/* Active Line Status Low Byte Register */ +#define SP_ACT_LINE_STAL_REG 0x26 + +/* Active Line Status High Byte Register */ +#define SP_ACT_LINE_STAH_REG 0x27 + +/* Vertical Front Porch Status Register */ +#define SP_V_F_PORCH_STA_REG 0x28 + +/* Vertical SYNC Width Status Register */ +#define SP_V_SYNC_STA_REG 0x29 + +/* Vertical Back Porch Status Register */ +#define SP_V_B_PORCH_STA_REG 0x2a + +/* Total Pixel Status Low Byte Register */ +#define SP_TOTAL_PIXEL_STAL_REG 0x2b + +/* Total Pixel Status High Byte Register */ +#define SP_TOTAL_PIXEL_STAH_REG 0x2c + +/* Active Pixel Status Low Byte Register */ +#define SP_ACT_PIXEL_STAL_REG 0x2d + +/* Active Pixel Status High Byte Register */ +#define SP_ACT_PIXEL_STAH_REG 0x2e + +/* Horizontal Front Porch Status Low Byte Register */ +#define SP_H_F_PORCH_STAL_REG 0x2f + +/* Horizontal Front Porch Statys High Byte Register */ +#define SP_H_F_PORCH_STAH_REG 0x30 + +/* Horizontal SYNC Width Status Low Byte Register */ +#define SP_H_SYNC_STAL_REG 0x31 + +/* Horizontal SYNC Width Status High Byte Register */ +#define SP_H_SYNC_STAH_REG 0x32 + +/* Horizontal Back Porch Status Low Byte Register */ +#define SP_H_B_PORCH_STAL_REG 0x33 + +/* Horizontal Back Porch Status High Byte Register */ +#define SP_H_B_PORCH_STAH_REG 0x34 + +/* InfoFrame AVI Packet Type Register */ +#define SP_INFOFRAME_AVI_TYPE_REG 0x70 + +/* InfoFrame AVI Packet Version Register */ +#define SP_INFOFRAME_AVI_VER_REG 0x71 + +/* InfoFrame AVI Packet Length Register */ +#define SP_INFOFRAME_AVI_LEN_REG 0x72 + +/* InfoFrame AVI Packet DB0 Register */ +#define SP_INFOFRAME_AVI_DB0_REG 0x73 + +/* Bit Control Specific Register */ +#define SP_BIT_CTRL_SPECIFIC_REG 0x80 +#define SP_BIT_CTRL_SELECT_SHIFT 1 +#define SP_ENABLE_BIT_CTRL BIT(0) + +/* InfoFrame Audio Packet Type Register */ +#define SP_INFOFRAME_AUD_TYPE_REG 0x83 + +/* InfoFrame Audio Packet Version Register */ +#define SP_INFOFRAME_AUD_VER_REG 0x84 + +/* InfoFrame Audio Packet Length Register */ +#define SP_INFOFRAME_AUD_LEN_REG 0x85 + +/* InfoFrame Audio Packet DB0 Register */ +#define SP_INFOFRAME_AUD_DB0_REG 0x86 + +/* InfoFrame MPEG Packet Type Register */ +#define SP_INFOFRAME_MPEG_TYPE_REG 0xb0 + +/* InfoFrame MPEG Packet Version Register */ +#define SP_INFOFRAME_MPEG_VER_REG 0xb1 + +/* InfoFrame MPEG Packet Length Register */ +#define SP_INFOFRAME_MPEG_LEN_REG 0xb2 + +/* InfoFrame MPEG Packet DB0 Register */ +#define SP_INFOFRAME_MPEG_DB0_REG 0xb3 + +/* Audio Channel Status Registers */ +#define SP_AUD_CH_STATUS_BASE (0xd0 - 1) + +/* Audio Channel Num Register 5 */ +#define SP_I2S_CHANNEL_NUM_MASK 0xe0 +# define SP_I2S_CH_NUM_1 (0x00 << 5) +# define SP_I2S_CH_NUM_2 (0x01 << 5) +# define SP_I2S_CH_NUM_3 (0x02 << 5) +# define SP_I2S_CH_NUM_4 (0x03 << 5) +# define SP_I2S_CH_NUM_5 (0x04 << 5) +# define SP_I2S_CH_NUM_6 (0x05 << 5) +# define SP_I2S_CH_NUM_7 (0x06 << 5) +# define SP_I2S_CH_NUM_8 (0x07 << 5) +#define SP_EXT_VUCP BIT(2) +#define SP_VBIT BIT(1) +#define SP_AUDIO_LAYOUT BIT(0) + +/* Analog Debug Register 2 */ +#define SP_ANALOG_DEBUG2_REG 0xdd +#define SP_FORCE_SW_OFF_BYPASS 0x20 +#define SP_XTAL_FRQ 0x1c +# define SP_XTAL_FRQ_19M2 (0x00 << 2) +# define SP_XTAL_FRQ_24M (0x01 << 2) +# define SP_XTAL_FRQ_25M (0x02 << 2) +# define SP_XTAL_FRQ_26M (0x03 << 2) +# define SP_XTAL_FRQ_27M (0x04 << 2) +# define SP_XTAL_FRQ_38M4 (0x05 << 2) +# define SP_XTAL_FRQ_52M (0x06 << 2) +#define SP_POWERON_TIME_1P5MS 0x03 + +/* Analog Control 0 Register */ +#define SP_ANALOG_CTRL0_REG 0xe1 + +/* Common Interrupt Status Register 1 */ +#define SP_COMMON_INT_STATUS_BASE (0xf1 - 1) +#define SP_PLL_LOCK_CHG 0x40 + +/* Common Interrupt Status Register 2 */ +#define SP_COMMON_INT_STATUS2 0xf2 +#define SP_HDCP_AUTH_CHG BIT(1) +#define SP_HDCP_AUTH_DONE BIT(0) + +#define SP_HDCP_LINK_CHECK_FAIL BIT(0) + +#define SP_HPD_IRQ BIT(6) +#define SP_HPD_ESYNC_ERR BIT(4) +#define SP_HPD_CHG BIT(2) +#define SP_HPD_LOST BIT(1) +#define SP_HPD_PLUG BIT(0) + +/* DP Interrupt Status Register */ +#define SP_DP_INT_STATUS_REG 0xf7 +#define SP_TRAINING_FINISH BIT(5) +#define SP_POLLING_ERR BIT(4) + +/* Common Interrupt Mask Register */ +#define SP_COMMON_INT_MASK_BASE (0xf8 - 1) + +/* Interrupt Control Register */ +#define SP_INT_CTRL_REG 0xff + +/***************************************************************/ +/* Register definition of device address 0x7a */ +/***************************************************************/ + +/* DP TX Link Training Control Register */ +#define SP_DP_TX_LT_CTRL0_REG 0x30 + +/* PD 1.2 Lint Training 80bit Pattern Register */ +#define SP_DP_LT_80BIT_PATTERN0_REG 0x80 +#define SP_DP_LT_80BIT_PATTERN_REG_NUM 10 + +/* Audio Interface Control Register 0 */ +#define SP_AUD_INTERFACE_CTRL0_REG 0x5f +#define SP_AUD_INTERFACE_DISABLE 0x80 + +/* Audio Interface Control Register 2 */ +#define SP_AUD_INTERFACE_CTRL2_REG 0x60 +#define SP_M_AUD_ADJUST_ST 0x04 + +/* Audio Interface Control Register 3 */ +#define SP_AUD_INTERFACE_CTRL3_REG 0x62 + +/* Audio Interface Control Register 4 */ +#define SP_AUD_INTERFACE_CTRL4_REG 0x67 + +/* Audio Interface Control Register 5 */ +#define SP_AUD_INTERFACE_CTRL5_REG 0x68 + +/* Audio Interface Control Register 6 */ +#define SP_AUD_INTERFACE_CTRL6_REG 0x69 + +/* Firmware Version Register */ +#define SP_FW_VER_REG 0xb7 + +/***************************************************************/ +/* Definition of DPCD */ +/***************************************************************/ +#define SP_DPCD_MAX_LINK_RATE 0x01 + +#define SP_DPCD_MAX_LANE_COUNT 0x02 +#define SP_ENHANCED_FRAME_CAP 0x80 + +#define SP_DPCD_LANE_COUNT_SET 0x01 +#define SP_ENHANCED_FRAME_EN 0x80 + +#define SP_DPCD_DOWNSPREADING_CTRL 0x07 +#define SP_SPREAD_AMPLITUDE 0x10 + +#define SP_DPCD_SINK_COUNT 0x00 +#define SP_DPCD_SERVICE_IRQ_VECTOR 0x01 +#define SP_TEST_IRQ 0x02 +#define SP_CP_IRQ 0x04 + +#define SP_TEST_ACK 0x01 + +#endif