drm/tegra: Add eDP support
authorThierry Reding <treding@nvidia.com>
Fri, 15 Nov 2013 15:06:05 +0000 (16:06 +0100)
committerThierry Reding <treding@nvidia.com>
Fri, 4 Apr 2014 07:12:50 +0000 (09:12 +0200)
Add support for eDP functionality found on Tegra124 and later SoCs. Only
fast link training is currently supported.

Signed-off-by: Thierry Reding <treding@nvidia.com>
Documentation/devicetree/bindings/gpu/nvidia,tegra20-host1x.txt
drivers/gpu/drm/tegra/Makefile
drivers/gpu/drm/tegra/dc.h
drivers/gpu/drm/tegra/dpaux.c [new file with mode: 0644]
drivers/gpu/drm/tegra/dpaux.h [new file with mode: 0644]
drivers/gpu/drm/tegra/drm.c
drivers/gpu/drm/tegra/drm.h
drivers/gpu/drm/tegra/output.c
drivers/gpu/drm/tegra/sor.c [new file with mode: 0644]
drivers/gpu/drm/tegra/sor.h [new file with mode: 0644]

index efaeec8961b64bddba0df9d48af9af65e630f659..efa8b8451f93be2600cbb41fa5c8275c7ea5ddaf 100644 (file)
@@ -190,6 +190,48 @@ of the following host1x client modules:
   - nvidia,edid: supplies a binary EDID blob
   - nvidia,panel: phandle of a display panel
 
+- sor: serial output resource
+
+  Required properties:
+  - compatible: "nvidia,tegra124-sor"
+  - reg: Physical base address and length of the controller's registers.
+  - interrupts: The interrupt outputs from the controller.
+  - clocks: Must contain an entry for each entry in clock-names.
+    See ../clocks/clock-bindings.txt for details.
+  - clock-names: Must include the following entries:
+    - sor: clock input for the SOR hardware
+    - parent: input for the pixel clock
+    - dp: reference clock for the SOR clock
+    - safe: safe reference for the SOR clock during power up
+  - resets: Must contain an entry for each entry in reset-names.
+    See ../reset/reset.txt for details.
+  - reset-names: Must include the following entries:
+    - sor
+
+  Optional properties:
+  - nvidia,ddc-i2c-bus: phandle of an I2C controller used for DDC EDID probing
+  - nvidia,hpd-gpio: specifies a GPIO used for hotplug detection
+  - nvidia,edid: supplies a binary EDID blob
+  - nvidia,panel: phandle of a display panel
+
+  Optional properties when driving an eDP output:
+  - nvidia,dpaux: phandle to a DispayPort AUX interface
+
+- dpaux: DisplayPort AUX interface
+  - compatible: "nvidia,tegra124-dpaux"
+  - reg: Physical base address and length of the controller's registers.
+  - interrupts: The interrupt outputs from the controller.
+  - clocks: Must contain an entry for each entry in clock-names.
+    See ../clocks/clock-bindings.txt for details.
+  - clock-names: Must include the following entries:
+    - dpaux: clock input for the DPAUX hardware
+    - parent: reference clock
+  - resets: Must contain an entry for each entry in reset-names.
+    See ../reset/reset.txt for details.
+  - reset-names: Must include the following entries:
+    - dpaux
+  - vdd-supply: phandle of a supply that powers the DisplayPort link
+
 Example:
 
 / {
index 8d220afbd85f94c6599a2ec0015c38ee7c87434b..d43f21bb459685b3cd26436902a45a171d412947 100644 (file)
@@ -11,6 +11,8 @@ tegra-drm-y := \
        hdmi.o \
        mipi-phy.o \
        dsi.o \
+       sor.o \
+       dpaux.o \
        gr2d.o \
        gr3d.o
 
index 3c2c0ea1cd87a84e1f3414a780788d868f676703..c94101494826c898e83d43fb86c9df12064a65b0 100644 (file)
 #define DC_DISP_DISP_WIN_OPTIONS               0x402
 #define HDMI_ENABLE (1 << 30)
 #define DSI_ENABLE  (1 << 29)
+#define SOR_ENABLE  (1 << 25)
 
 #define DC_DISP_DISP_MEM_HIGH_PRIORITY         0x403
 #define CURSOR_THRESHOLD(x)   (((x) & 0x03) << 24)
diff --git a/drivers/gpu/drm/tegra/dpaux.c b/drivers/gpu/drm/tegra/dpaux.c
new file mode 100644 (file)
index 0000000..d536ed3
--- /dev/null
@@ -0,0 +1,544 @@
+/*
+ * Copyright (C) 2013 NVIDIA Corporation
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ */
+
+#include <linux/clk.h>
+#include <linux/delay.h>
+#include <linux/gpio.h>
+#include <linux/interrupt.h>
+#include <linux/io.h>
+#include <linux/of_gpio.h>
+#include <linux/platform_device.h>
+#include <linux/reset.h>
+#include <linux/regulator/consumer.h>
+
+#include <drm/drm_dp_helper.h>
+#include <drm/drm_panel.h>
+
+#include "dpaux.h"
+#include "drm.h"
+
+static DEFINE_MUTEX(dpaux_lock);
+static LIST_HEAD(dpaux_list);
+
+struct tegra_dpaux {
+       struct drm_dp_aux aux;
+       struct device *dev;
+
+       void __iomem *regs;
+       int irq;
+
+       struct tegra_output *output;
+
+       struct reset_control *rst;
+       struct clk *clk_parent;
+       struct clk *clk;
+
+       struct regulator *vdd;
+
+       struct completion complete;
+       struct list_head list;
+};
+
+static inline struct tegra_dpaux *to_dpaux(struct drm_dp_aux *aux)
+{
+       return container_of(aux, struct tegra_dpaux, aux);
+}
+
+static inline unsigned long tegra_dpaux_readl(struct tegra_dpaux *dpaux,
+                                             unsigned long offset)
+{
+       return readl(dpaux->regs + (offset << 2));
+}
+
+static inline void tegra_dpaux_writel(struct tegra_dpaux *dpaux,
+                                     unsigned long value,
+                                     unsigned long offset)
+{
+       writel(value, dpaux->regs + (offset << 2));
+}
+
+static void tegra_dpaux_write_fifo(struct tegra_dpaux *dpaux, const u8 *buffer,
+                                  size_t size)
+{
+       unsigned long offset = DPAUX_DP_AUXDATA_WRITE(0);
+       size_t i, j;
+
+       for (i = 0; i < size; i += 4) {
+               size_t num = min_t(size_t, size - i, 4);
+               unsigned long value = 0;
+
+               for (j = 0; j < num; j++)
+                       value |= buffer[i + j] << (j * 8);
+
+               tegra_dpaux_writel(dpaux, value, offset++);
+       }
+}
+
+static void tegra_dpaux_read_fifo(struct tegra_dpaux *dpaux, u8 *buffer,
+                                 size_t size)
+{
+       unsigned long offset = DPAUX_DP_AUXDATA_READ(0);
+       size_t i, j;
+
+       for (i = 0; i < size; i += 4) {
+               size_t num = min_t(size_t, size - i, 4);
+               unsigned long value;
+
+               value = tegra_dpaux_readl(dpaux, offset++);
+
+               for (j = 0; j < num; j++)
+                       buffer[i + j] = value >> (j * 8);
+       }
+}
+
+static ssize_t tegra_dpaux_transfer(struct drm_dp_aux *aux,
+                                   struct drm_dp_aux_msg *msg)
+{
+       unsigned long value = DPAUX_DP_AUXCTL_TRANSACTREQ;
+       unsigned long timeout = msecs_to_jiffies(250);
+       struct tegra_dpaux *dpaux = to_dpaux(aux);
+       unsigned long status;
+       ssize_t ret = 0;
+
+       if (msg->size < 1 || msg->size > 16)
+               return -EINVAL;
+
+       tegra_dpaux_writel(dpaux, msg->address, DPAUX_DP_AUXADDR);
+
+       switch (msg->request & ~DP_AUX_I2C_MOT) {
+       case DP_AUX_I2C_WRITE:
+               if (msg->request & DP_AUX_I2C_MOT)
+                       value = DPAUX_DP_AUXCTL_CMD_MOT_WR;
+               else
+                       value = DPAUX_DP_AUXCTL_CMD_I2C_WR;
+
+               break;
+
+       case DP_AUX_I2C_READ:
+               if (msg->request & DP_AUX_I2C_MOT)
+                       value = DPAUX_DP_AUXCTL_CMD_MOT_RD;
+               else
+                       value = DPAUX_DP_AUXCTL_CMD_I2C_RD;
+
+               break;
+
+       case DP_AUX_I2C_STATUS:
+               if (msg->request & DP_AUX_I2C_MOT)
+                       value = DPAUX_DP_AUXCTL_CMD_MOT_RQ;
+               else
+                       value = DPAUX_DP_AUXCTL_CMD_I2C_RQ;
+
+               break;
+
+       case DP_AUX_NATIVE_WRITE:
+               value = DPAUX_DP_AUXCTL_CMD_AUX_WR;
+               break;
+
+       case DP_AUX_NATIVE_READ:
+               value = DPAUX_DP_AUXCTL_CMD_AUX_RD;
+               break;
+
+       default:
+               return -EINVAL;
+       }
+
+       value |= DPAUX_DP_AUXCTL_CMDLEN(msg->size - 1);
+       tegra_dpaux_writel(dpaux, value, DPAUX_DP_AUXCTL);
+
+       if ((msg->request & DP_AUX_I2C_READ) == 0) {
+               tegra_dpaux_write_fifo(dpaux, msg->buffer, msg->size);
+               ret = msg->size;
+       }
+
+       /* start transaction */
+       value = tegra_dpaux_readl(dpaux, DPAUX_DP_AUXCTL);
+       value |= DPAUX_DP_AUXCTL_TRANSACTREQ;
+       tegra_dpaux_writel(dpaux, value, DPAUX_DP_AUXCTL);
+
+       status = wait_for_completion_timeout(&dpaux->complete, timeout);
+       if (!status)
+               return -ETIMEDOUT;
+
+       /* read status and clear errors */
+       value = tegra_dpaux_readl(dpaux, DPAUX_DP_AUXSTAT);
+       tegra_dpaux_writel(dpaux, 0xf00, DPAUX_DP_AUXSTAT);
+
+       if (value & DPAUX_DP_AUXSTAT_TIMEOUT_ERROR)
+               return -ETIMEDOUT;
+
+       if ((value & DPAUX_DP_AUXSTAT_RX_ERROR) ||
+           (value & DPAUX_DP_AUXSTAT_SINKSTAT_ERROR) ||
+           (value & DPAUX_DP_AUXSTAT_NO_STOP_ERROR))
+               return -EIO;
+
+       switch ((value & DPAUX_DP_AUXSTAT_REPLY_TYPE_MASK) >> 16) {
+       case 0x00:
+               msg->reply = DP_AUX_NATIVE_REPLY_ACK;
+               break;
+
+       case 0x01:
+               msg->reply = DP_AUX_NATIVE_REPLY_NACK;
+               break;
+
+       case 0x02:
+               msg->reply = DP_AUX_NATIVE_REPLY_DEFER;
+               break;
+
+       case 0x04:
+               msg->reply = DP_AUX_I2C_REPLY_NACK;
+               break;
+
+       case 0x08:
+               msg->reply = DP_AUX_I2C_REPLY_DEFER;
+               break;
+       }
+
+       if (msg->reply == DP_AUX_NATIVE_REPLY_ACK) {
+               if (msg->request & DP_AUX_I2C_READ) {
+                       size_t count = value & DPAUX_DP_AUXSTAT_REPLY_MASK;
+
+                       if (WARN_ON(count != msg->size))
+                               count = min_t(size_t, count, msg->size);
+
+                       tegra_dpaux_read_fifo(dpaux, msg->buffer, count);
+                       ret = count;
+               }
+       }
+
+       return ret;
+}
+
+static irqreturn_t tegra_dpaux_irq(int irq, void *data)
+{
+       struct tegra_dpaux *dpaux = data;
+       irqreturn_t ret = IRQ_HANDLED;
+       unsigned long value;
+
+       /* clear interrupts */
+       value = tegra_dpaux_readl(dpaux, DPAUX_INTR_AUX);
+       tegra_dpaux_writel(dpaux, value, DPAUX_INTR_AUX);
+
+       if (value & DPAUX_INTR_PLUG_EVENT) {
+               if (dpaux->output) {
+                       drm_helper_hpd_irq_event(dpaux->output->connector.dev);
+               }
+       }
+
+       if (value & DPAUX_INTR_UNPLUG_EVENT) {
+               if (dpaux->output)
+                       drm_helper_hpd_irq_event(dpaux->output->connector.dev);
+       }
+
+       if (value & DPAUX_INTR_IRQ_EVENT) {
+               /* TODO: handle this */
+       }
+
+       if (value & DPAUX_INTR_AUX_DONE)
+               complete(&dpaux->complete);
+
+       return ret;
+}
+
+static int tegra_dpaux_probe(struct platform_device *pdev)
+{
+       struct tegra_dpaux *dpaux;
+       struct resource *regs;
+       unsigned long value;
+       int err;
+
+       dpaux = devm_kzalloc(&pdev->dev, sizeof(*dpaux), GFP_KERNEL);
+       if (!dpaux)
+               return -ENOMEM;
+
+       init_completion(&dpaux->complete);
+       INIT_LIST_HEAD(&dpaux->list);
+       dpaux->dev = &pdev->dev;
+
+       regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+       dpaux->regs = devm_ioremap_resource(&pdev->dev, regs);
+       if (IS_ERR(dpaux->regs))
+               return PTR_ERR(dpaux->regs);
+
+       dpaux->irq = platform_get_irq(pdev, 0);
+       if (dpaux->irq < 0) {
+               dev_err(&pdev->dev, "failed to get IRQ\n");
+               return -ENXIO;
+       }
+
+       dpaux->rst = devm_reset_control_get(&pdev->dev, "dpaux");
+       if (IS_ERR(dpaux->rst))
+               return PTR_ERR(dpaux->rst);
+
+       dpaux->clk = devm_clk_get(&pdev->dev, NULL);
+       if (IS_ERR(dpaux->clk))
+               return PTR_ERR(dpaux->clk);
+
+       err = clk_prepare_enable(dpaux->clk);
+       if (err < 0)
+               return err;
+
+       reset_control_deassert(dpaux->rst);
+
+       dpaux->clk_parent = devm_clk_get(&pdev->dev, "parent");
+       if (IS_ERR(dpaux->clk_parent))
+               return PTR_ERR(dpaux->clk_parent);
+
+       err = clk_prepare_enable(dpaux->clk_parent);
+       if (err < 0)
+               return err;
+
+       err = clk_set_rate(dpaux->clk_parent, 270000000);
+       if (err < 0) {
+               dev_err(&pdev->dev, "failed to set clock to 270 MHz: %d\n",
+                       err);
+               return err;
+       }
+
+       dpaux->vdd = devm_regulator_get(&pdev->dev, "vdd");
+       if (IS_ERR(dpaux->vdd))
+               return PTR_ERR(dpaux->vdd);
+
+       err = devm_request_irq(dpaux->dev, dpaux->irq, tegra_dpaux_irq, 0,
+                              dev_name(dpaux->dev), dpaux);
+       if (err < 0) {
+               dev_err(dpaux->dev, "failed to request IRQ#%u: %d\n",
+                       dpaux->irq, err);
+               return err;
+       }
+
+       dpaux->aux.transfer = tegra_dpaux_transfer;
+       dpaux->aux.dev = &pdev->dev;
+
+       err = drm_dp_aux_register_i2c_bus(&dpaux->aux);
+       if (err < 0)
+               return err;
+
+       /* enable and clear all interrupts */
+       value = DPAUX_INTR_AUX_DONE | DPAUX_INTR_IRQ_EVENT |
+               DPAUX_INTR_UNPLUG_EVENT | DPAUX_INTR_PLUG_EVENT;
+       tegra_dpaux_writel(dpaux, value, DPAUX_INTR_EN_AUX);
+       tegra_dpaux_writel(dpaux, value, DPAUX_INTR_AUX);
+
+       mutex_lock(&dpaux_lock);
+       list_add_tail(&dpaux->list, &dpaux_list);
+       mutex_unlock(&dpaux_lock);
+
+       platform_set_drvdata(pdev, dpaux);
+
+       return 0;
+}
+
+static int tegra_dpaux_remove(struct platform_device *pdev)
+{
+       struct tegra_dpaux *dpaux = platform_get_drvdata(pdev);
+
+       drm_dp_aux_unregister_i2c_bus(&dpaux->aux);
+
+       mutex_lock(&dpaux_lock);
+       list_del(&dpaux->list);
+       mutex_unlock(&dpaux_lock);
+
+       clk_disable_unprepare(dpaux->clk_parent);
+       reset_control_assert(dpaux->rst);
+       clk_disable_unprepare(dpaux->clk);
+
+       return 0;
+}
+
+static const struct of_device_id tegra_dpaux_of_match[] = {
+       { .compatible = "nvidia,tegra124-dpaux", },
+       { },
+};
+
+struct platform_driver tegra_dpaux_driver = {
+       .driver = {
+               .name = "tegra-dpaux",
+               .of_match_table = tegra_dpaux_of_match,
+       },
+       .probe = tegra_dpaux_probe,
+       .remove = tegra_dpaux_remove,
+};
+
+struct tegra_dpaux *tegra_dpaux_find_by_of_node(struct device_node *np)
+{
+       struct tegra_dpaux *dpaux;
+
+       mutex_lock(&dpaux_lock);
+
+       list_for_each_entry(dpaux, &dpaux_list, list)
+               if (np == dpaux->dev->of_node) {
+                       mutex_unlock(&dpaux_lock);
+                       return dpaux;
+               }
+
+       mutex_unlock(&dpaux_lock);
+
+       return NULL;
+}
+
+int tegra_dpaux_attach(struct tegra_dpaux *dpaux, struct tegra_output *output)
+{
+       unsigned long timeout;
+       int err;
+
+       dpaux->output = output;
+
+       err = regulator_enable(dpaux->vdd);
+       if (err < 0)
+               return err;
+
+       timeout = jiffies + msecs_to_jiffies(250);
+
+       while (time_before(jiffies, timeout)) {
+               enum drm_connector_status status;
+
+               status = tegra_dpaux_detect(dpaux);
+               if (status == connector_status_connected)
+                       return 0;
+
+               usleep_range(1000, 2000);
+       }
+
+       return -ETIMEDOUT;
+}
+
+int tegra_dpaux_detach(struct tegra_dpaux *dpaux)
+{
+       unsigned long timeout;
+       int err;
+
+       err = regulator_disable(dpaux->vdd);
+       if (err < 0)
+               return err;
+
+       timeout = jiffies + msecs_to_jiffies(250);
+
+       while (time_before(jiffies, timeout)) {
+               enum drm_connector_status status;
+
+               status = tegra_dpaux_detect(dpaux);
+               if (status == connector_status_disconnected) {
+                       dpaux->output = NULL;
+                       return 0;
+               }
+
+               usleep_range(1000, 2000);
+       }
+
+       return -ETIMEDOUT;
+}
+
+enum drm_connector_status tegra_dpaux_detect(struct tegra_dpaux *dpaux)
+{
+       unsigned long value;
+
+       value = tegra_dpaux_readl(dpaux, DPAUX_DP_AUXSTAT);
+
+       if (value & DPAUX_DP_AUXSTAT_HPD_STATUS)
+               return connector_status_connected;
+
+       return connector_status_disconnected;
+}
+
+int tegra_dpaux_enable(struct tegra_dpaux *dpaux)
+{
+       unsigned long value;
+
+       value = DPAUX_HYBRID_PADCTL_AUX_CMH(2) |
+               DPAUX_HYBRID_PADCTL_AUX_DRVZ(4) |
+               DPAUX_HYBRID_PADCTL_AUX_DRVI(0x18) |
+               DPAUX_HYBRID_PADCTL_AUX_INPUT_RCV |
+               DPAUX_HYBRID_PADCTL_MODE_AUX;
+       tegra_dpaux_writel(dpaux, value, DPAUX_HYBRID_PADCTL);
+
+       value = tegra_dpaux_readl(dpaux, DPAUX_HYBRID_SPARE);
+       value &= ~DPAUX_HYBRID_SPARE_PAD_POWER_DOWN;
+       tegra_dpaux_writel(dpaux, value, DPAUX_HYBRID_SPARE);
+
+       return 0;
+}
+
+int tegra_dpaux_disable(struct tegra_dpaux *dpaux)
+{
+       unsigned long value;
+
+       value = tegra_dpaux_readl(dpaux, DPAUX_HYBRID_SPARE);
+       value |= DPAUX_HYBRID_SPARE_PAD_POWER_DOWN;
+       tegra_dpaux_writel(dpaux, value, DPAUX_HYBRID_SPARE);
+
+       return 0;
+}
+
+int tegra_dpaux_prepare(struct tegra_dpaux *dpaux, u8 encoding)
+{
+       int err;
+
+       err = drm_dp_dpcd_writeb(&dpaux->aux, DP_MAIN_LINK_CHANNEL_CODING_SET,
+                                encoding);
+       if (err < 0)
+               return err;
+
+       return 0;
+}
+
+int tegra_dpaux_train(struct tegra_dpaux *dpaux, struct drm_dp_link *link,
+                     u8 pattern)
+{
+       u8 tp = pattern & DP_TRAINING_PATTERN_MASK;
+       u8 status[DP_LINK_STATUS_SIZE], values[4];
+       unsigned int i;
+       int err;
+
+       err = drm_dp_dpcd_writeb(&dpaux->aux, DP_TRAINING_PATTERN_SET, pattern);
+       if (err < 0)
+               return err;
+
+       if (tp == DP_TRAINING_PATTERN_DISABLE)
+               return 0;
+
+       for (i = 0; i < link->num_lanes; i++)
+               values[i] = DP_TRAIN_MAX_PRE_EMPHASIS_REACHED |
+                           DP_TRAIN_PRE_EMPHASIS_0 |
+                           DP_TRAIN_MAX_SWING_REACHED |
+                           DP_TRAIN_VOLTAGE_SWING_400;
+
+       err = drm_dp_dpcd_write(&dpaux->aux, DP_TRAINING_LANE0_SET, values,
+                               link->num_lanes);
+       if (err < 0)
+               return err;
+
+       usleep_range(500, 1000);
+
+       err = drm_dp_dpcd_read_link_status(&dpaux->aux, status);
+       if (err < 0)
+               return err;
+
+       switch (tp) {
+       case DP_TRAINING_PATTERN_1:
+               if (!drm_dp_clock_recovery_ok(status, link->num_lanes))
+                       return -EAGAIN;
+
+               break;
+
+       case DP_TRAINING_PATTERN_2:
+               if (!drm_dp_channel_eq_ok(status, link->num_lanes))
+                       return -EAGAIN;
+
+               break;
+
+       default:
+               dev_err(dpaux->dev, "unsupported training pattern %u\n", tp);
+               return -EINVAL;
+       }
+
+       err = drm_dp_dpcd_writeb(&dpaux->aux, DP_EDP_CONFIGURATION_SET, 0);
+       if (err < 0)
+               return err;
+
+       return 0;
+}
diff --git a/drivers/gpu/drm/tegra/dpaux.h b/drivers/gpu/drm/tegra/dpaux.h
new file mode 100644 (file)
index 0000000..4f5bf10
--- /dev/null
@@ -0,0 +1,73 @@
+/*
+ * Copyright (C) 2013 NVIDIA Corporation
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ */
+
+#ifndef DRM_TEGRA_DPAUX_H
+#define DRM_TEGRA_DPAUX_H
+
+#define DPAUX_CTXSW 0x00
+
+#define DPAUX_INTR_EN_AUX 0x01
+#define DPAUX_INTR_AUX 0x05
+#define DPAUX_INTR_AUX_DONE (1 << 3)
+#define DPAUX_INTR_IRQ_EVENT (1 << 2)
+#define DPAUX_INTR_UNPLUG_EVENT (1 << 1)
+#define DPAUX_INTR_PLUG_EVENT (1 << 0)
+
+#define DPAUX_DP_AUXDATA_WRITE(x) (0x09 + ((x) << 2))
+#define DPAUX_DP_AUXDATA_READ(x) (0x19 + ((x) << 2))
+#define DPAUX_DP_AUXADDR 0x29
+
+#define DPAUX_DP_AUXCTL 0x2d
+#define DPAUX_DP_AUXCTL_TRANSACTREQ (1 << 16)
+#define DPAUX_DP_AUXCTL_CMD_AUX_RD (9 << 12)
+#define DPAUX_DP_AUXCTL_CMD_AUX_WR (8 << 12)
+#define DPAUX_DP_AUXCTL_CMD_MOT_RQ (6 << 12)
+#define DPAUX_DP_AUXCTL_CMD_MOT_RD (5 << 12)
+#define DPAUX_DP_AUXCTL_CMD_MOT_WR (4 << 12)
+#define DPAUX_DP_AUXCTL_CMD_I2C_RQ (2 << 12)
+#define DPAUX_DP_AUXCTL_CMD_I2C_RD (1 << 12)
+#define DPAUX_DP_AUXCTL_CMD_I2C_WR (0 << 12)
+#define DPAUX_DP_AUXCTL_CMDLEN(x) ((x) & 0xff)
+
+#define DPAUX_DP_AUXSTAT 0x31
+#define DPAUX_DP_AUXSTAT_HPD_STATUS (1 << 28)
+#define DPAUX_DP_AUXSTAT_REPLY_TYPE_MASK (0xf0000)
+#define DPAUX_DP_AUXSTAT_NO_STOP_ERROR (1 << 11)
+#define DPAUX_DP_AUXSTAT_SINKSTAT_ERROR (1 << 10)
+#define DPAUX_DP_AUXSTAT_RX_ERROR (1 << 9)
+#define DPAUX_DP_AUXSTAT_TIMEOUT_ERROR (1 << 8)
+#define DPAUX_DP_AUXSTAT_REPLY_MASK (0xff)
+
+#define DPAUX_DP_AUX_SINKSTAT_LO 0x35
+#define DPAUX_DP_AUX_SINKSTAT_HI 0x39
+
+#define DPAUX_HPD_CONFIG 0x3d
+#define DPAUX_HPD_CONFIG_UNPLUG_MIN_TIME(x) (((x) & 0xffff) << 16)
+#define DPAUX_HPD_CONFIG_PLUG_MIN_TIME(x) ((x) & 0xffff)
+
+#define DPAUX_HPD_IRQ_CONFIG 0x41
+#define DPAUX_HPD_IRQ_CONFIG_MIN_LOW_TIME(x) ((x) & 0xffff)
+
+#define DPAUX_DP_AUX_CONFIG 0x45
+
+#define DPAUX_HYBRID_PADCTL 0x49
+#define DPAUX_HYBRID_PADCTL_AUX_CMH(x) (((x) & 0x3) << 12)
+#define DPAUX_HYBRID_PADCTL_AUX_DRVZ(x) (((x) & 0x7) << 8)
+#define DPAUX_HYBRID_PADCTL_AUX_DRVI(x) (((x) & 0x3f) << 2)
+#define DPAUX_HYBRID_PADCTL_AUX_INPUT_RCV (1 << 1)
+#define DPAUX_HYBRID_PADCTL_MODE_I2C (1 << 0)
+#define DPAUX_HYBRID_PADCTL_MODE_AUX (0 << 0)
+
+#define DPAUX_HYBRID_SPARE 0x4d
+#define DPAUX_HYBRID_SPARE_PAD_POWER_DOWN (1 << 0)
+
+#define DPAUX_SCRATCH_REG0 0x51
+#define DPAUX_SCRATCH_REG1 0x55
+#define DPAUX_SCRATCH_REG2 0x59
+
+#endif
index 88a529008ce0e59210e917422b2cfe07570a0d7d..4c583d58334ac0b69c46b26d5ba7ad93bd6774c2 100644 (file)
@@ -665,6 +665,7 @@ static const struct of_device_id host1x_drm_subdevs[] = {
        { .compatible = "nvidia,tegra114-hdmi", },
        { .compatible = "nvidia,tegra114-gr3d", },
        { .compatible = "nvidia,tegra124-dc", },
+       { .compatible = "nvidia,tegra124-sor", },
        { /* sentinel */ }
 };
 
@@ -691,14 +692,22 @@ static int __init host1x_drm_init(void)
        if (err < 0)
                goto unregister_dc;
 
-       err = platform_driver_register(&tegra_hdmi_driver);
+       err = platform_driver_register(&tegra_sor_driver);
        if (err < 0)
                goto unregister_dsi;
 
-       err = platform_driver_register(&tegra_gr2d_driver);
+       err = platform_driver_register(&tegra_hdmi_driver);
+       if (err < 0)
+               goto unregister_sor;
+
+       err = platform_driver_register(&tegra_dpaux_driver);
        if (err < 0)
                goto unregister_hdmi;
 
+       err = platform_driver_register(&tegra_gr2d_driver);
+       if (err < 0)
+               goto unregister_dpaux;
+
        err = platform_driver_register(&tegra_gr3d_driver);
        if (err < 0)
                goto unregister_gr2d;
@@ -707,8 +716,12 @@ static int __init host1x_drm_init(void)
 
 unregister_gr2d:
        platform_driver_unregister(&tegra_gr2d_driver);
+unregister_dpaux:
+       platform_driver_unregister(&tegra_dpaux_driver);
 unregister_hdmi:
        platform_driver_unregister(&tegra_hdmi_driver);
+unregister_sor:
+       platform_driver_unregister(&tegra_sor_driver);
 unregister_dsi:
        platform_driver_unregister(&tegra_dsi_driver);
 unregister_dc:
@@ -723,7 +736,9 @@ static void __exit host1x_drm_exit(void)
 {
        platform_driver_unregister(&tegra_gr3d_driver);
        platform_driver_unregister(&tegra_gr2d_driver);
+       platform_driver_unregister(&tegra_dpaux_driver);
        platform_driver_unregister(&tegra_hdmi_driver);
+       platform_driver_unregister(&tegra_sor_driver);
        platform_driver_unregister(&tegra_dsi_driver);
        platform_driver_unregister(&tegra_dc_driver);
        host1x_driver_unregister(&host1x_drm_driver);
index bf1cac7658f8d20333ce0cefbac8383e62f98c37..126332c3ecbb6b82c4f18388ae7a809ae7c6a28c 100644 (file)
@@ -179,12 +179,14 @@ struct tegra_output_ops {
        int (*check_mode)(struct tegra_output *output,
                          struct drm_display_mode *mode,
                          enum drm_mode_status *status);
+       enum drm_connector_status (*detect)(struct tegra_output *output);
 };
 
 enum tegra_output_type {
        TEGRA_OUTPUT_RGB,
        TEGRA_OUTPUT_HDMI,
        TEGRA_OUTPUT_DSI,
+       TEGRA_OUTPUT_EDP,
 };
 
 struct tegra_output {
@@ -265,6 +267,22 @@ extern int tegra_output_remove(struct tegra_output *output);
 extern int tegra_output_init(struct drm_device *drm, struct tegra_output *output);
 extern int tegra_output_exit(struct tegra_output *output);
 
+/* from dpaux.c */
+
+struct tegra_dpaux;
+struct drm_dp_link;
+struct drm_dp_aux;
+
+struct tegra_dpaux *tegra_dpaux_find_by_of_node(struct device_node *np);
+enum drm_connector_status tegra_dpaux_detect(struct tegra_dpaux *dpaux);
+int tegra_dpaux_attach(struct tegra_dpaux *dpaux, struct tegra_output *output);
+int tegra_dpaux_detach(struct tegra_dpaux *dpaux);
+int tegra_dpaux_enable(struct tegra_dpaux *dpaux);
+int tegra_dpaux_disable(struct tegra_dpaux *dpaux);
+int tegra_dpaux_prepare(struct tegra_dpaux *dpaux, u8 encoding);
+int tegra_dpaux_train(struct tegra_dpaux *dpaux, struct drm_dp_link *link,
+                     u8 pattern);
+
 /* from fb.c */
 struct tegra_bo *tegra_fb_get_plane(struct drm_framebuffer *framebuffer,
                                    unsigned int index);
@@ -278,7 +296,9 @@ extern void tegra_fbdev_restore_mode(struct tegra_fbdev *fbdev);
 
 extern struct platform_driver tegra_dc_driver;
 extern struct platform_driver tegra_dsi_driver;
+extern struct platform_driver tegra_sor_driver;
 extern struct platform_driver tegra_hdmi_driver;
+extern struct platform_driver tegra_dpaux_driver;
 extern struct platform_driver tegra_gr2d_driver;
 extern struct platform_driver tegra_gr3d_driver;
 
index 57cecbd18ca88d210a6e83e61c3f3cff208f26e5..a3e4f1eca6f7b479796889498906c259d3faa882 100644 (file)
@@ -77,6 +77,9 @@ tegra_connector_detect(struct drm_connector *connector, bool force)
        struct tegra_output *output = connector_to_output(connector);
        enum drm_connector_status status = connector_status_unknown;
 
+       if (output->ops->detect)
+               return output->ops->detect(output);
+
        if (gpio_is_valid(output->hpd_gpio)) {
                if (gpio_get_value(output->hpd_gpio) == 0)
                        status = connector_status_disconnected;
@@ -292,6 +295,11 @@ int tegra_output_init(struct drm_device *drm, struct tegra_output *output)
                encoder = DRM_MODE_ENCODER_DSI;
                break;
 
+       case TEGRA_OUTPUT_EDP:
+               connector = DRM_MODE_CONNECTOR_eDP;
+               encoder = DRM_MODE_ENCODER_TMDS;
+               break;
+
        default:
                connector = DRM_MODE_CONNECTOR_Unknown;
                encoder = DRM_MODE_ENCODER_NONE;
diff --git a/drivers/gpu/drm/tegra/sor.c b/drivers/gpu/drm/tegra/sor.c
new file mode 100644 (file)
index 0000000..49ef572
--- /dev/null
@@ -0,0 +1,1092 @@
+/*
+ * Copyright (C) 2013 NVIDIA Corporation
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ */
+
+#include <linux/clk.h>
+#include <linux/io.h>
+#include <linux/platform_device.h>
+#include <linux/reset.h>
+#include <linux/tegra-powergate.h>
+
+#include <drm/drm_dp_helper.h>
+
+#include "dc.h"
+#include "drm.h"
+#include "sor.h"
+
+struct tegra_sor {
+       struct host1x_client client;
+       struct tegra_output output;
+       struct device *dev;
+
+       void __iomem *regs;
+
+       struct reset_control *rst;
+       struct clk *clk_parent;
+       struct clk *clk_safe;
+       struct clk *clk_dp;
+       struct clk *clk;
+
+       struct tegra_dpaux *dpaux;
+
+       bool enabled;
+};
+
+static inline struct tegra_sor *
+host1x_client_to_sor(struct host1x_client *client)
+{
+       return container_of(client, struct tegra_sor, client);
+}
+
+static inline struct tegra_sor *to_sor(struct tegra_output *output)
+{
+       return container_of(output, struct tegra_sor, output);
+}
+
+static inline unsigned long tegra_sor_readl(struct tegra_sor *sor,
+                                           unsigned long offset)
+{
+       return readl(sor->regs + (offset << 2));
+}
+
+static inline void tegra_sor_writel(struct tegra_sor *sor, unsigned long value,
+                                   unsigned long offset)
+{
+       writel(value, sor->regs + (offset << 2));
+}
+
+static int tegra_sor_dp_train_fast(struct tegra_sor *sor,
+                                  struct drm_dp_link *link)
+{
+       unsigned long value;
+       unsigned int i;
+       u8 pattern;
+       int err;
+
+       /* setup lane parameters */
+       value = SOR_LANE_DRIVE_CURRENT_LANE3(0x40) |
+               SOR_LANE_DRIVE_CURRENT_LANE2(0x40) |
+               SOR_LANE_DRIVE_CURRENT_LANE1(0x40) |
+               SOR_LANE_DRIVE_CURRENT_LANE0(0x40);
+       tegra_sor_writel(sor, value, SOR_LANE_DRIVE_CURRENT_0);
+
+       value = SOR_LANE_PREEMPHASIS_LANE3(0x0f) |
+               SOR_LANE_PREEMPHASIS_LANE2(0x0f) |
+               SOR_LANE_PREEMPHASIS_LANE1(0x0f) |
+               SOR_LANE_PREEMPHASIS_LANE0(0x0f);
+       tegra_sor_writel(sor, value, SOR_LANE_PREEMPHASIS_0);
+
+       value = SOR_LANE_POST_CURSOR_LANE3(0x00) |
+               SOR_LANE_POST_CURSOR_LANE2(0x00) |
+               SOR_LANE_POST_CURSOR_LANE1(0x00) |
+               SOR_LANE_POST_CURSOR_LANE0(0x00);
+       tegra_sor_writel(sor, value, SOR_LANE_POST_CURSOR_0);
+
+       /* disable LVDS mode */
+       tegra_sor_writel(sor, 0, SOR_LVDS);
+
+       value = tegra_sor_readl(sor, SOR_DP_PADCTL_0);
+       value |= SOR_DP_PADCTL_TX_PU_ENABLE;
+       value &= ~SOR_DP_PADCTL_TX_PU_MASK;
+       value |= SOR_DP_PADCTL_TX_PU(2); /* XXX: don't hardcode? */
+       tegra_sor_writel(sor, value, SOR_DP_PADCTL_0);
+
+       value = tegra_sor_readl(sor, SOR_DP_PADCTL_0);
+       value |= SOR_DP_PADCTL_CM_TXD_3 | SOR_DP_PADCTL_CM_TXD_2 |
+                SOR_DP_PADCTL_CM_TXD_1 | SOR_DP_PADCTL_CM_TXD_0;
+       tegra_sor_writel(sor, value, SOR_DP_PADCTL_0);
+
+       usleep_range(10, 100);
+
+       value = tegra_sor_readl(sor, SOR_DP_PADCTL_0);
+       value &= ~(SOR_DP_PADCTL_CM_TXD_3 | SOR_DP_PADCTL_CM_TXD_2 |
+                  SOR_DP_PADCTL_CM_TXD_1 | SOR_DP_PADCTL_CM_TXD_0);
+       tegra_sor_writel(sor, value, SOR_DP_PADCTL_0);
+
+       err = tegra_dpaux_prepare(sor->dpaux, DP_SET_ANSI_8B10B);
+       if (err < 0)
+               return err;
+
+       for (i = 0, value = 0; i < link->num_lanes; i++) {
+               unsigned long lane = SOR_DP_TPG_CHANNEL_CODING |
+                                    SOR_DP_TPG_SCRAMBLER_NONE |
+                                    SOR_DP_TPG_PATTERN_TRAIN1;
+               value = (value << 8) | lane;
+       }
+
+       tegra_sor_writel(sor, value, SOR_DP_TPG);
+
+       pattern = DP_TRAINING_PATTERN_1;
+
+       err = tegra_dpaux_train(sor->dpaux, link, pattern);
+       if (err < 0)
+               return err;
+
+       value = tegra_sor_readl(sor, SOR_DP_SPARE_0);
+       value |= SOR_DP_SPARE_SEQ_ENABLE;
+       value &= ~SOR_DP_SPARE_PANEL_INTERNAL;
+       value |= SOR_DP_SPARE_MACRO_SOR_CLK;
+       tegra_sor_writel(sor, value, SOR_DP_SPARE_0);
+
+       for (i = 0, value = 0; i < link->num_lanes; i++) {
+               unsigned long lane = SOR_DP_TPG_CHANNEL_CODING |
+                                    SOR_DP_TPG_SCRAMBLER_NONE |
+                                    SOR_DP_TPG_PATTERN_TRAIN2;
+               value = (value << 8) | lane;
+       }
+
+       tegra_sor_writel(sor, value, SOR_DP_TPG);
+
+       pattern = DP_LINK_SCRAMBLING_DISABLE | DP_TRAINING_PATTERN_2;
+
+       err = tegra_dpaux_train(sor->dpaux, link, pattern);
+       if (err < 0)
+               return err;
+
+       for (i = 0, value = 0; i < link->num_lanes; i++) {
+               unsigned long lane = SOR_DP_TPG_CHANNEL_CODING |
+                                    SOR_DP_TPG_SCRAMBLER_GALIOS |
+                                    SOR_DP_TPG_PATTERN_NONE;
+               value = (value << 8) | lane;
+       }
+
+       tegra_sor_writel(sor, value, SOR_DP_TPG);
+
+       pattern = DP_TRAINING_PATTERN_DISABLE;
+
+       err = tegra_dpaux_train(sor->dpaux, link, pattern);
+       if (err < 0)
+               return err;
+
+       return 0;
+}
+
+static void tegra_sor_super_update(struct tegra_sor *sor)
+{
+       tegra_sor_writel(sor, 0, SOR_SUPER_STATE_0);
+       tegra_sor_writel(sor, 1, SOR_SUPER_STATE_0);
+       tegra_sor_writel(sor, 0, SOR_SUPER_STATE_0);
+}
+
+static void tegra_sor_update(struct tegra_sor *sor)
+{
+       tegra_sor_writel(sor, 0, SOR_STATE_0);
+       tegra_sor_writel(sor, 1, SOR_STATE_0);
+       tegra_sor_writel(sor, 0, SOR_STATE_0);
+}
+
+static int tegra_sor_setup_pwm(struct tegra_sor *sor, unsigned long timeout)
+{
+       unsigned long value;
+
+       value = tegra_sor_readl(sor, SOR_PWM_DIV);
+       value &= ~SOR_PWM_DIV_MASK;
+       value |= 0x400; /* period */
+       tegra_sor_writel(sor, value, SOR_PWM_DIV);
+
+       value = tegra_sor_readl(sor, SOR_PWM_CTL);
+       value &= ~SOR_PWM_CTL_DUTY_CYCLE_MASK;
+       value |= 0x400; /* duty cycle */
+       value &= ~SOR_PWM_CTL_CLK_SEL; /* clock source: PCLK */
+       value |= SOR_PWM_CTL_TRIGGER;
+       tegra_sor_writel(sor, value, SOR_PWM_CTL);
+
+       timeout = jiffies + msecs_to_jiffies(timeout);
+
+       while (time_before(jiffies, timeout)) {
+               value = tegra_sor_readl(sor, SOR_PWM_CTL);
+               if ((value & SOR_PWM_CTL_TRIGGER) == 0)
+                       return 0;
+
+               usleep_range(25, 100);
+       }
+
+       return -ETIMEDOUT;
+}
+
+static int tegra_sor_attach(struct tegra_sor *sor)
+{
+       unsigned long value, timeout;
+
+       /* wake up in normal mode */
+       value = tegra_sor_readl(sor, SOR_SUPER_STATE_1);
+       value |= SOR_SUPER_STATE_HEAD_MODE_AWAKE;
+       value |= SOR_SUPER_STATE_MODE_NORMAL;
+       tegra_sor_writel(sor, value, SOR_SUPER_STATE_1);
+       tegra_sor_super_update(sor);
+
+       /* attach */
+       value = tegra_sor_readl(sor, SOR_SUPER_STATE_1);
+       value |= SOR_SUPER_STATE_ATTACHED;
+       tegra_sor_writel(sor, value, SOR_SUPER_STATE_1);
+       tegra_sor_super_update(sor);
+
+       timeout = jiffies + msecs_to_jiffies(250);
+
+       while (time_before(jiffies, timeout)) {
+               value = tegra_sor_readl(sor, SOR_TEST);
+               if ((value & SOR_TEST_ATTACHED) != 0)
+                       return 0;
+
+               usleep_range(25, 100);
+       }
+
+       return -ETIMEDOUT;
+}
+
+static int tegra_sor_wakeup(struct tegra_sor *sor)
+{
+       struct tegra_dc *dc = to_tegra_dc(sor->output.encoder.crtc);
+       unsigned long value, timeout;
+
+       /* enable display controller outputs */
+       value = tegra_dc_readl(dc, DC_CMD_DISPLAY_POWER_CONTROL);
+       value |= PW0_ENABLE | PW1_ENABLE | PW2_ENABLE | PW3_ENABLE |
+                PW4_ENABLE | PM0_ENABLE | PM1_ENABLE;
+       tegra_dc_writel(dc, value, DC_CMD_DISPLAY_POWER_CONTROL);
+
+       tegra_dc_writel(dc, GENERAL_ACT_REQ << 8, DC_CMD_STATE_CONTROL);
+       tegra_dc_writel(dc, GENERAL_ACT_REQ, DC_CMD_STATE_CONTROL);
+
+       timeout = jiffies + msecs_to_jiffies(250);
+
+       /* wait for head to wake up */
+       while (time_before(jiffies, timeout)) {
+               value = tegra_sor_readl(sor, SOR_TEST);
+               value &= SOR_TEST_HEAD_MODE_MASK;
+
+               if (value == SOR_TEST_HEAD_MODE_AWAKE)
+                       return 0;
+
+               usleep_range(25, 100);
+       }
+
+       return -ETIMEDOUT;
+}
+
+static int tegra_sor_power_up(struct tegra_sor *sor, unsigned long timeout)
+{
+       unsigned long value;
+
+       value = tegra_sor_readl(sor, SOR_PWR);
+       value |= SOR_PWR_TRIGGER | SOR_PWR_NORMAL_STATE_PU;
+       tegra_sor_writel(sor, value, SOR_PWR);
+
+       timeout = jiffies + msecs_to_jiffies(timeout);
+
+       while (time_before(jiffies, timeout)) {
+               value = tegra_sor_readl(sor, SOR_PWR);
+               if ((value & SOR_PWR_TRIGGER) == 0)
+                       return 0;
+
+               usleep_range(25, 100);
+       }
+
+       return -ETIMEDOUT;
+}
+
+static int tegra_output_sor_enable(struct tegra_output *output)
+{
+       struct tegra_dc *dc = to_tegra_dc(output->encoder.crtc);
+       struct drm_display_mode *mode = &dc->base.mode;
+       unsigned int vbe, vse, hbe, hse, vbs, hbs, i;
+       struct tegra_sor *sor = to_sor(output);
+       unsigned long value;
+       int err;
+
+       if (sor->enabled)
+               return 0;
+
+       err = clk_prepare_enable(sor->clk);
+       if (err < 0)
+               return err;
+
+       reset_control_deassert(sor->rst);
+
+       if (sor->dpaux) {
+               err = tegra_dpaux_enable(sor->dpaux);
+               if (err < 0)
+                       dev_err(sor->dev, "failed to enable DP: %d\n", err);
+       }
+
+       err = clk_set_parent(sor->clk, sor->clk_safe);
+       if (err < 0)
+               dev_err(sor->dev, "failed to set safe parent clock: %d\n", err);
+
+       value = tegra_sor_readl(sor, SOR_CLK_CNTRL);
+       value &= ~SOR_CLK_CNTRL_DP_CLK_SEL_MASK;
+       value |= SOR_CLK_CNTRL_DP_CLK_SEL_SINGLE_DPCLK;
+       tegra_sor_writel(sor, value, SOR_CLK_CNTRL);
+
+       value = tegra_sor_readl(sor, SOR_PLL_2);
+       value &= ~SOR_PLL_2_BANDGAP_POWERDOWN;
+       tegra_sor_writel(sor, value, SOR_PLL_2);
+       usleep_range(20, 100);
+
+       value = tegra_sor_readl(sor, SOR_PLL_3);
+       value |= SOR_PLL_3_PLL_VDD_MODE_V3_3;
+       tegra_sor_writel(sor, value, SOR_PLL_3);
+
+       value = SOR_PLL_0_ICHPMP(0xf) | SOR_PLL_0_VCOCAP_RST |
+               SOR_PLL_0_PLLREG_LEVEL_V45 | SOR_PLL_0_RESISTOR_EXT;
+       tegra_sor_writel(sor, value, SOR_PLL_0);
+
+       value = tegra_sor_readl(sor, SOR_PLL_2);
+       value |= SOR_PLL_2_SEQ_PLLCAPPD;
+       value &= ~SOR_PLL_2_SEQ_PLLCAPPD_ENFORCE;
+       value |= SOR_PLL_2_LVDS_ENABLE;
+       tegra_sor_writel(sor, value, SOR_PLL_2);
+
+       value = SOR_PLL_1_TERM_COMPOUT | SOR_PLL_1_TMDS_TERM;
+       tegra_sor_writel(sor, value, SOR_PLL_1);
+
+       while (true) {
+               value = tegra_sor_readl(sor, SOR_PLL_2);
+               if ((value & SOR_PLL_2_SEQ_PLLCAPPD_ENFORCE) == 0)
+                       break;
+
+               usleep_range(250, 1000);
+       }
+
+       value = tegra_sor_readl(sor, SOR_PLL_2);
+       value &= ~SOR_PLL_2_POWERDOWN_OVERRIDE;
+       value &= ~SOR_PLL_2_PORT_POWERDOWN;
+       tegra_sor_writel(sor, value, SOR_PLL_2);
+
+       /*
+        * power up
+        */
+
+       /* set safe link bandwidth (1.62 Gbps) */
+       value = tegra_sor_readl(sor, SOR_CLK_CNTRL);
+       value &= ~SOR_CLK_CNTRL_DP_LINK_SPEED_MASK;
+       value |= SOR_CLK_CNTRL_DP_LINK_SPEED_G1_62;
+       tegra_sor_writel(sor, value, SOR_CLK_CNTRL);
+
+       /* step 1 */
+       value = tegra_sor_readl(sor, SOR_PLL_2);
+       value |= SOR_PLL_2_SEQ_PLLCAPPD_ENFORCE | SOR_PLL_2_PORT_POWERDOWN |
+                SOR_PLL_2_BANDGAP_POWERDOWN;
+       tegra_sor_writel(sor, value, SOR_PLL_2);
+
+       value = tegra_sor_readl(sor, SOR_PLL_0);
+       value |= SOR_PLL_0_VCOPD | SOR_PLL_0_POWER_OFF;
+       tegra_sor_writel(sor, value, SOR_PLL_0);
+
+       value = tegra_sor_readl(sor, SOR_DP_PADCTL_0);
+       value &= ~SOR_DP_PADCTL_PAD_CAL_PD;
+       tegra_sor_writel(sor, value, SOR_DP_PADCTL_0);
+
+       /* step 2 */
+       err = tegra_io_rail_power_on(TEGRA_IO_RAIL_LVDS);
+       if (err < 0) {
+               dev_err(sor->dev, "failed to power on I/O rail: %d\n", err);
+               return err;
+       }
+
+       usleep_range(5, 100);
+
+       /* step 3 */
+       value = tegra_sor_readl(sor, SOR_PLL_2);
+       value &= ~SOR_PLL_2_BANDGAP_POWERDOWN;
+       tegra_sor_writel(sor, value, SOR_PLL_2);
+
+       usleep_range(20, 100);
+
+       /* step 4 */
+       value = tegra_sor_readl(sor, SOR_PLL_0);
+       value &= ~SOR_PLL_0_POWER_OFF;
+       value &= ~SOR_PLL_0_VCOPD;
+       tegra_sor_writel(sor, value, SOR_PLL_0);
+
+       value = tegra_sor_readl(sor, SOR_PLL_2);
+       value &= ~SOR_PLL_2_SEQ_PLLCAPPD_ENFORCE;
+       tegra_sor_writel(sor, value, SOR_PLL_2);
+
+       usleep_range(200, 1000);
+
+       /* step 5 */
+       value = tegra_sor_readl(sor, SOR_PLL_2);
+       value &= ~SOR_PLL_2_PORT_POWERDOWN;
+       tegra_sor_writel(sor, value, SOR_PLL_2);
+
+       /* switch to DP clock */
+       err = clk_set_parent(sor->clk, sor->clk_dp);
+       if (err < 0)
+               dev_err(sor->dev, "failed to set DP parent clock: %d\n", err);
+
+       /* power dplanes (XXX parameterize based on link?) */
+       value = tegra_sor_readl(sor, SOR_DP_PADCTL_0);
+       value |= SOR_DP_PADCTL_PD_TXD_3 | SOR_DP_PADCTL_PD_TXD_0 |
+                SOR_DP_PADCTL_PD_TXD_1 | SOR_DP_PADCTL_PD_TXD_2;
+       tegra_sor_writel(sor, value, SOR_DP_PADCTL_0);
+
+       value = tegra_sor_readl(sor, SOR_DP_LINKCTL_0);
+       value &= ~SOR_DP_LINKCTL_LANE_COUNT_MASK;
+       value |= SOR_DP_LINKCTL_LANE_COUNT(4);
+       tegra_sor_writel(sor, value, SOR_DP_LINKCTL_0);
+
+       /* start lane sequencer */
+       value = SOR_LANE_SEQ_CTL_TRIGGER | SOR_LANE_SEQ_CTL_SEQUENCE_DOWN |
+               SOR_LANE_SEQ_CTL_POWER_STATE_UP;
+       tegra_sor_writel(sor, value, SOR_LANE_SEQ_CTL);
+
+       while (true) {
+               value = tegra_sor_readl(sor, SOR_LANE_SEQ_CTL);
+               if ((value & SOR_LANE_SEQ_CTL_TRIGGER) == 0)
+                       break;
+
+               usleep_range(250, 1000);
+       }
+
+       /* set link bandwidth (2.7 GHz, XXX: parameterize based on link?) */
+       value = tegra_sor_readl(sor, SOR_CLK_CNTRL);
+       value &= ~SOR_CLK_CNTRL_DP_LINK_SPEED_MASK;
+       value |= SOR_CLK_CNTRL_DP_LINK_SPEED_G2_70;
+       tegra_sor_writel(sor, value, SOR_CLK_CNTRL);
+
+       /* set linkctl */
+       value = tegra_sor_readl(sor, SOR_DP_LINKCTL_0);
+       value |= SOR_DP_LINKCTL_ENABLE;
+
+       value &= ~SOR_DP_LINKCTL_TU_SIZE_MASK;
+       value |= SOR_DP_LINKCTL_TU_SIZE(59); /* XXX: don't hardcode? */
+
+       value |= SOR_DP_LINKCTL_ENHANCED_FRAME;
+       tegra_sor_writel(sor, value, SOR_DP_LINKCTL_0);
+
+       for (i = 0, value = 0; i < 4; i++) {
+               unsigned long lane = SOR_DP_TPG_CHANNEL_CODING |
+                                    SOR_DP_TPG_SCRAMBLER_GALIOS |
+                                    SOR_DP_TPG_PATTERN_NONE;
+               value = (value << 8) | lane;
+       }
+
+       tegra_sor_writel(sor, value, SOR_DP_TPG);
+
+       value = tegra_sor_readl(sor, SOR_DP_CONFIG_0);
+       value &= ~SOR_DP_CONFIG_WATERMARK_MASK;
+       value |= SOR_DP_CONFIG_WATERMARK(14); /* XXX: don't hardcode? */
+
+       value &= ~SOR_DP_CONFIG_ACTIVE_SYM_COUNT_MASK;
+       value |= SOR_DP_CONFIG_ACTIVE_SYM_COUNT(47); /* XXX: don't hardcode? */
+
+       value &= ~SOR_DP_CONFIG_ACTIVE_SYM_FRAC_MASK;
+       value |= SOR_DP_CONFIG_ACTIVE_SYM_FRAC(9); /* XXX: don't hardcode? */
+
+       value &= ~SOR_DP_CONFIG_ACTIVE_SYM_POLARITY; /* XXX: don't hardcode? */
+
+       value |= SOR_DP_CONFIG_ACTIVE_SYM_ENABLE;
+       value |= SOR_DP_CONFIG_DISPARITY_NEGATIVE; /* XXX: don't hardcode? */
+       tegra_sor_writel(sor, value, SOR_DP_CONFIG_0);
+
+       value = tegra_sor_readl(sor, SOR_DP_AUDIO_HBLANK_SYMBOLS);
+       value &= ~SOR_DP_AUDIO_HBLANK_SYMBOLS_MASK;
+       value |= 137; /* XXX: don't hardcode? */
+       tegra_sor_writel(sor, value, SOR_DP_AUDIO_HBLANK_SYMBOLS);
+
+       value = tegra_sor_readl(sor, SOR_DP_AUDIO_VBLANK_SYMBOLS);
+       value &= ~SOR_DP_AUDIO_VBLANK_SYMBOLS_MASK;
+       value |= 2368; /* XXX: don't hardcode? */
+       tegra_sor_writel(sor, value, SOR_DP_AUDIO_VBLANK_SYMBOLS);
+
+       /* enable pad calibration logic */
+       value = tegra_sor_readl(sor, SOR_DP_PADCTL_0);
+       value |= SOR_DP_PADCTL_PAD_CAL_PD;
+       tegra_sor_writel(sor, value, SOR_DP_PADCTL_0);
+
+       if (sor->dpaux) {
+               /* FIXME: properly convert to struct drm_dp_aux */
+               struct drm_dp_aux *aux = (struct drm_dp_aux *)sor->dpaux;
+               struct drm_dp_link link;
+               u8 rate, lanes;
+
+               err = drm_dp_link_probe(aux, &link);
+               if (err < 0) {
+                       dev_err(sor->dev, "failed to probe eDP link: %d\n",
+                               err);
+                       return err;
+               }
+
+               err = drm_dp_link_power_up(aux, &link);
+               if (err < 0) {
+                       dev_err(sor->dev, "failed to power up eDP link: %d\n",
+                               err);
+                       return err;
+               }
+
+               err = drm_dp_link_configure(aux, &link);
+               if (err < 0) {
+                       dev_err(sor->dev, "failed to configure eDP link: %d\n",
+                               err);
+                       return err;
+               }
+
+               rate = drm_dp_link_rate_to_bw_code(link.rate);
+               lanes = link.num_lanes;
+
+               value = tegra_sor_readl(sor, SOR_CLK_CNTRL);
+               value &= ~SOR_CLK_CNTRL_DP_LINK_SPEED_MASK;
+               value |= SOR_CLK_CNTRL_DP_LINK_SPEED(rate);
+               tegra_sor_writel(sor, value, SOR_CLK_CNTRL);
+
+               value = tegra_sor_readl(sor, SOR_DP_LINKCTL_0);
+               value &= ~SOR_DP_LINKCTL_LANE_COUNT_MASK;
+               value |= SOR_DP_LINKCTL_LANE_COUNT(lanes);
+
+               if (link.capabilities & DP_LINK_CAP_ENHANCED_FRAMING)
+                       value |= SOR_DP_LINKCTL_ENHANCED_FRAME;
+
+               tegra_sor_writel(sor, value, SOR_DP_LINKCTL_0);
+
+               /* disable training pattern generator */
+
+               for (i = 0; i < link.num_lanes; i++) {
+                       unsigned long lane = SOR_DP_TPG_CHANNEL_CODING |
+                                            SOR_DP_TPG_SCRAMBLER_GALIOS |
+                                            SOR_DP_TPG_PATTERN_NONE;
+                       value = (value << 8) | lane;
+               }
+
+               tegra_sor_writel(sor, value, SOR_DP_TPG);
+
+               err = tegra_sor_dp_train_fast(sor, &link);
+               if (err < 0) {
+                       dev_err(sor->dev, "DP fast link training failed: %d\n",
+                               err);
+                       return err;
+               }
+
+               dev_dbg(sor->dev, "fast link training succeeded\n");
+       }
+
+       err = tegra_sor_power_up(sor, 250);
+       if (err < 0) {
+               dev_err(sor->dev, "failed to power up SOR: %d\n", err);
+               return err;
+       }
+
+       /* start display controller in continuous mode */
+       value = tegra_dc_readl(dc, DC_CMD_STATE_ACCESS);
+       value |= WRITE_MUX;
+       tegra_dc_writel(dc, value, DC_CMD_STATE_ACCESS);
+
+       tegra_dc_writel(dc, VSYNC_H_POSITION(1), DC_DISP_DISP_TIMING_OPTIONS);
+       tegra_dc_writel(dc, DISP_CTRL_MODE_C_DISPLAY, DC_CMD_DISPLAY_COMMAND);
+
+       value = tegra_dc_readl(dc, DC_CMD_STATE_ACCESS);
+       value &= ~WRITE_MUX;
+       tegra_dc_writel(dc, value, DC_CMD_STATE_ACCESS);
+
+       /*
+        * configure panel (24bpp, vsync-, hsync-, DP-A protocol, complete
+        * raster, associate with display controller)
+        */
+       value = SOR_STATE_ASY_PIXELDEPTH_BPP_24_444 |
+               SOR_STATE_ASY_VSYNCPOL |
+               SOR_STATE_ASY_HSYNCPOL |
+               SOR_STATE_ASY_PROTOCOL_DP_A |
+               SOR_STATE_ASY_CRC_MODE_COMPLETE |
+               SOR_STATE_ASY_OWNER(dc->pipe + 1);
+       tegra_sor_writel(sor, value, SOR_STATE_1);
+
+       /*
+        * TODO: The video timing programming below doesn't seem to match the
+        * register definitions.
+        */
+
+       value = ((mode->vtotal & 0x7fff) << 16) | (mode->htotal & 0x7fff);
+       tegra_sor_writel(sor, value, SOR_HEAD_STATE_1(0));
+
+       vse = mode->vsync_end - mode->vsync_start - 1;
+       hse = mode->hsync_end - mode->hsync_start - 1;
+
+       value = ((vse & 0x7fff) << 16) | (hse & 0x7fff);
+       tegra_sor_writel(sor, value, SOR_HEAD_STATE_2(0));
+
+       vbe = vse + (mode->vsync_start - mode->vdisplay);
+       hbe = hse + (mode->hsync_start - mode->hdisplay);
+
+       value = ((vbe & 0x7fff) << 16) | (hbe & 0x7fff);
+       tegra_sor_writel(sor, value, SOR_HEAD_STATE_3(0));
+
+       vbs = vbe + mode->vdisplay;
+       hbs = hbe + mode->hdisplay;
+
+       value = ((vbs & 0x7fff) << 16) | (hbs & 0x7fff);
+       tegra_sor_writel(sor, value, SOR_HEAD_STATE_4(0));
+
+       /* XXX interlaced mode */
+       tegra_sor_writel(sor, 0x00000001, SOR_HEAD_STATE_5(0));
+
+       /* CSTM (LVDS, link A/B, upper) */
+       value = SOR_CSTM_LVDS | SOR_CSTM_LINK_ACT_B | SOR_CSTM_LINK_ACT_B |
+               SOR_CSTM_UPPER;
+       tegra_sor_writel(sor, value, SOR_CSTM);
+
+       /* PWM setup */
+       err = tegra_sor_setup_pwm(sor, 250);
+       if (err < 0) {
+               dev_err(sor->dev, "failed to setup PWM: %d\n", err);
+               return err;
+       }
+
+       value = tegra_dc_readl(dc, DC_DISP_DISP_WIN_OPTIONS);
+       value |= SOR_ENABLE;
+       tegra_dc_writel(dc, value, DC_DISP_DISP_WIN_OPTIONS);
+
+       tegra_sor_update(sor);
+
+       err = tegra_sor_attach(sor);
+       if (err < 0) {
+               dev_err(sor->dev, "failed to attach SOR: %d\n", err);
+               return err;
+       }
+
+       err = tegra_sor_wakeup(sor);
+       if (err < 0) {
+               dev_err(sor->dev, "failed to enable DC: %d\n", err);
+               return err;
+       }
+
+       sor->enabled = true;
+
+       return 0;
+}
+
+static int tegra_sor_detach(struct tegra_sor *sor)
+{
+       unsigned long value, timeout;
+
+       /* switch to safe mode */
+       value = tegra_sor_readl(sor, SOR_SUPER_STATE_1);
+       value &= ~SOR_SUPER_STATE_MODE_NORMAL;
+       tegra_sor_writel(sor, value, SOR_SUPER_STATE_1);
+       tegra_sor_super_update(sor);
+
+       timeout = jiffies + msecs_to_jiffies(250);
+
+       while (time_before(jiffies, timeout)) {
+               value = tegra_sor_readl(sor, SOR_PWR);
+               if (value & SOR_PWR_MODE_SAFE)
+                       break;
+       }
+
+       if ((value & SOR_PWR_MODE_SAFE) == 0)
+               return -ETIMEDOUT;
+
+       /* go to sleep */
+       value = tegra_sor_readl(sor, SOR_SUPER_STATE_1);
+       value &= ~SOR_SUPER_STATE_HEAD_MODE_MASK;
+       tegra_sor_writel(sor, value, SOR_SUPER_STATE_1);
+       tegra_sor_super_update(sor);
+
+       /* detach */
+       value = tegra_sor_readl(sor, SOR_SUPER_STATE_1);
+       value &= ~SOR_SUPER_STATE_ATTACHED;
+       tegra_sor_writel(sor, value, SOR_SUPER_STATE_1);
+       tegra_sor_super_update(sor);
+
+       timeout = jiffies + msecs_to_jiffies(250);
+
+       while (time_before(jiffies, timeout)) {
+               value = tegra_sor_readl(sor, SOR_TEST);
+               if ((value & SOR_TEST_ATTACHED) == 0)
+                       break;
+
+               usleep_range(25, 100);
+       }
+
+       if ((value & SOR_TEST_ATTACHED) != 0)
+               return -ETIMEDOUT;
+
+       return 0;
+}
+
+static int tegra_sor_power_down(struct tegra_sor *sor)
+{
+       unsigned long value, timeout;
+       int err;
+
+       value = tegra_sor_readl(sor, SOR_PWR);
+       value &= ~SOR_PWR_NORMAL_STATE_PU;
+       value |= SOR_PWR_TRIGGER;
+       tegra_sor_writel(sor, value, SOR_PWR);
+
+       timeout = jiffies + msecs_to_jiffies(250);
+
+       while (time_before(jiffies, timeout)) {
+               value = tegra_sor_readl(sor, SOR_PWR);
+               if ((value & SOR_PWR_TRIGGER) == 0)
+                       return 0;
+
+               usleep_range(25, 100);
+       }
+
+       if ((value & SOR_PWR_TRIGGER) != 0)
+               return -ETIMEDOUT;
+
+       err = clk_set_parent(sor->clk, sor->clk_safe);
+       if (err < 0)
+               dev_err(sor->dev, "failed to set safe parent clock: %d\n", err);
+
+       value = tegra_sor_readl(sor, SOR_DP_PADCTL_0);
+       value &= ~(SOR_DP_PADCTL_PD_TXD_3 | SOR_DP_PADCTL_PD_TXD_0 |
+                  SOR_DP_PADCTL_PD_TXD_1 | SOR_DP_PADCTL_PD_TXD_2);
+       tegra_sor_writel(sor, value, SOR_DP_PADCTL_0);
+
+       /* stop lane sequencer */
+       value = SOR_LANE_SEQ_CTL_TRIGGER | SOR_LANE_SEQ_CTL_SEQUENCE_DOWN |
+               SOR_LANE_SEQ_CTL_POWER_STATE_DOWN;
+       tegra_sor_writel(sor, value, SOR_LANE_SEQ_CTL);
+
+       timeout = jiffies + msecs_to_jiffies(250);
+
+       while (time_before(jiffies, timeout)) {
+               value = tegra_sor_readl(sor, SOR_LANE_SEQ_CTL);
+               if ((value & SOR_LANE_SEQ_CTL_TRIGGER) == 0)
+                       break;
+
+               usleep_range(25, 100);
+       }
+
+       if ((value & SOR_LANE_SEQ_CTL_TRIGGER) != 0)
+               return -ETIMEDOUT;
+
+       value = tegra_sor_readl(sor, SOR_PLL_2);
+       value |= SOR_PLL_2_PORT_POWERDOWN;
+       tegra_sor_writel(sor, value, SOR_PLL_2);
+
+       usleep_range(20, 100);
+
+       value = tegra_sor_readl(sor, SOR_PLL_0);
+       value |= SOR_PLL_0_POWER_OFF;
+       value |= SOR_PLL_0_VCOPD;
+       tegra_sor_writel(sor, value, SOR_PLL_0);
+
+       value = tegra_sor_readl(sor, SOR_PLL_2);
+       value |= SOR_PLL_2_SEQ_PLLCAPPD;
+       value |= SOR_PLL_2_SEQ_PLLCAPPD_ENFORCE;
+       tegra_sor_writel(sor, value, SOR_PLL_2);
+
+       usleep_range(20, 100);
+
+       return 0;
+}
+
+static int tegra_output_sor_disable(struct tegra_output *output)
+{
+       struct tegra_dc *dc = to_tegra_dc(output->encoder.crtc);
+       struct tegra_sor *sor = to_sor(output);
+       unsigned long value;
+       int err;
+
+       if (!sor->enabled)
+               return 0;
+
+       err = tegra_sor_detach(sor);
+       if (err < 0) {
+               dev_err(sor->dev, "failed to detach SOR: %d\n", err);
+               return err;
+       }
+
+       tegra_sor_writel(sor, 0, SOR_STATE_1);
+       tegra_sor_update(sor);
+
+       /*
+        * The following accesses registers of the display controller, so make
+        * sure it's only executed when the output is attached to one.
+        */
+       if (dc) {
+               /*
+                * XXX: We can't do this here because it causes the SOR to go
+                * into an erroneous state and the output will look scrambled
+                * the next time it is enabled. Presumably this is because we
+                * should be doing this only on the next VBLANK. A possible
+                * solution would be to queue a "power-off" event to trigger
+                * this code to be run during the next VBLANK.
+                */
+               /*
+               value = tegra_dc_readl(dc, DC_CMD_DISPLAY_POWER_CONTROL);
+               value &= ~(PW0_ENABLE | PW1_ENABLE | PW2_ENABLE | PW3_ENABLE |
+                          PW4_ENABLE | PM0_ENABLE | PM1_ENABLE);
+               tegra_dc_writel(dc, value, DC_CMD_DISPLAY_POWER_CONTROL);
+               */
+
+               value = tegra_dc_readl(dc, DC_CMD_DISPLAY_COMMAND);
+               value &= ~DISP_CTRL_MODE_MASK;
+               tegra_dc_writel(dc, value, DC_CMD_DISPLAY_COMMAND);
+
+               value = tegra_dc_readl(dc, DC_DISP_DISP_WIN_OPTIONS);
+               value &= ~SOR_ENABLE;
+               tegra_dc_writel(dc, value, DC_DISP_DISP_WIN_OPTIONS);
+
+               tegra_dc_writel(dc, GENERAL_ACT_REQ << 8, DC_CMD_STATE_CONTROL);
+               tegra_dc_writel(dc, GENERAL_ACT_REQ, DC_CMD_STATE_CONTROL);
+       }
+
+       err = tegra_sor_power_down(sor);
+       if (err < 0) {
+               dev_err(sor->dev, "failed to power down SOR: %d\n", err);
+               return err;
+       }
+
+       if (sor->dpaux) {
+               err = tegra_dpaux_disable(sor->dpaux);
+               if (err < 0) {
+                       dev_err(sor->dev, "failed to disable DP: %d\n", err);
+                       return err;
+               }
+       }
+
+       err = tegra_io_rail_power_off(TEGRA_IO_RAIL_LVDS);
+       if (err < 0) {
+               dev_err(sor->dev, "failed to power off I/O rail: %d\n", err);
+               return err;
+       }
+
+       reset_control_assert(sor->rst);
+       clk_disable_unprepare(sor->clk);
+
+       sor->enabled = false;
+
+       return 0;
+}
+
+static int tegra_output_sor_setup_clock(struct tegra_output *output,
+                                       struct clk *clk, unsigned long pclk)
+{
+       struct tegra_sor *sor = to_sor(output);
+       int err;
+
+       /* round to next MHz */
+       pclk = DIV_ROUND_UP(pclk / 2, 1000000) * 1000000;
+
+       err = clk_set_parent(clk, sor->clk_parent);
+       if (err < 0) {
+               dev_err(sor->dev, "failed to set parent clock: %d\n", err);
+               return err;
+       }
+
+       err = clk_set_rate(sor->clk_parent, pclk);
+       if (err < 0) {
+               dev_err(sor->dev, "failed to set base clock rate to %lu Hz\n",
+                       pclk * 2);
+               return err;
+       }
+
+       return 0;
+}
+
+static int tegra_output_sor_check_mode(struct tegra_output *output,
+                                      struct drm_display_mode *mode,
+                                      enum drm_mode_status *status)
+{
+       /*
+        * FIXME: For now, always assume that the mode is okay.
+        */
+
+       *status = MODE_OK;
+
+       return 0;
+}
+
+static enum drm_connector_status
+tegra_output_sor_detect(struct tegra_output *output)
+{
+       struct tegra_sor *sor = to_sor(output);
+
+       if (sor->dpaux)
+               return tegra_dpaux_detect(sor->dpaux);
+
+       return connector_status_unknown;
+}
+
+static const struct tegra_output_ops sor_ops = {
+       .enable = tegra_output_sor_enable,
+       .disable = tegra_output_sor_disable,
+       .setup_clock = tegra_output_sor_setup_clock,
+       .check_mode = tegra_output_sor_check_mode,
+       .detect = tegra_output_sor_detect,
+};
+
+static int tegra_sor_init(struct host1x_client *client)
+{
+       struct tegra_drm *tegra = dev_get_drvdata(client->parent);
+       struct tegra_sor *sor = host1x_client_to_sor(client);
+       int err;
+
+       if (!sor->dpaux)
+               return -ENODEV;
+
+       sor->output.type = TEGRA_OUTPUT_EDP;
+
+       sor->output.dev = sor->dev;
+       sor->output.ops = &sor_ops;
+
+       err = tegra_output_init(tegra->drm, &sor->output);
+       if (err < 0) {
+               dev_err(sor->dev, "output setup failed: %d\n", err);
+               return err;
+       }
+
+       if (sor->dpaux) {
+               err = tegra_dpaux_attach(sor->dpaux, &sor->output);
+               if (err < 0) {
+                       dev_err(sor->dev, "failed to attach DP: %d\n", err);
+                       return err;
+               }
+       }
+
+       return 0;
+}
+
+static int tegra_sor_exit(struct host1x_client *client)
+{
+       struct tegra_sor *sor = host1x_client_to_sor(client);
+       int err;
+
+       err = tegra_output_disable(&sor->output);
+       if (err < 0) {
+               dev_err(sor->dev, "output failed to disable: %d\n", err);
+               return err;
+       }
+
+       if (sor->dpaux) {
+               err = tegra_dpaux_detach(sor->dpaux);
+               if (err < 0) {
+                       dev_err(sor->dev, "failed to detach DP: %d\n", err);
+                       return err;
+               }
+       }
+
+       err = tegra_output_exit(&sor->output);
+       if (err < 0) {
+               dev_err(sor->dev, "output cleanup failed: %d\n", err);
+               return err;
+       }
+
+       return 0;
+}
+
+static const struct host1x_client_ops sor_client_ops = {
+       .init = tegra_sor_init,
+       .exit = tegra_sor_exit,
+};
+
+static int tegra_sor_probe(struct platform_device *pdev)
+{
+       struct device_node *np;
+       struct tegra_sor *sor;
+       struct resource *regs;
+       int err;
+
+       sor = devm_kzalloc(&pdev->dev, sizeof(*sor), GFP_KERNEL);
+       if (!sor)
+               return -ENOMEM;
+
+       sor->output.dev = sor->dev = &pdev->dev;
+
+       np = of_parse_phandle(pdev->dev.of_node, "nvidia,dpaux", 0);
+       if (np) {
+               sor->dpaux = tegra_dpaux_find_by_of_node(np);
+               of_node_put(np);
+
+               if (!sor->dpaux)
+                       return -EPROBE_DEFER;
+       }
+
+       err = tegra_output_probe(&sor->output);
+       if (err < 0)
+               return err;
+
+       regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+       sor->regs = devm_ioremap_resource(&pdev->dev, regs);
+       if (IS_ERR(sor->regs))
+               return PTR_ERR(sor->regs);
+
+       sor->rst = devm_reset_control_get(&pdev->dev, "sor");
+       if (IS_ERR(sor->rst))
+               return PTR_ERR(sor->rst);
+
+       sor->clk = devm_clk_get(&pdev->dev, NULL);
+       if (IS_ERR(sor->clk))
+               return PTR_ERR(sor->clk);
+
+       sor->clk_parent = devm_clk_get(&pdev->dev, "parent");
+       if (IS_ERR(sor->clk_parent))
+               return PTR_ERR(sor->clk_parent);
+
+       err = clk_prepare_enable(sor->clk_parent);
+       if (err < 0)
+               return err;
+
+       sor->clk_safe = devm_clk_get(&pdev->dev, "safe");
+       if (IS_ERR(sor->clk_safe))
+               return PTR_ERR(sor->clk_safe);
+
+       err = clk_prepare_enable(sor->clk_safe);
+       if (err < 0)
+               return err;
+
+       sor->clk_dp = devm_clk_get(&pdev->dev, "dp");
+       if (IS_ERR(sor->clk_dp))
+               return PTR_ERR(sor->clk_dp);
+
+       err = clk_prepare_enable(sor->clk_dp);
+       if (err < 0)
+               return err;
+
+       INIT_LIST_HEAD(&sor->client.list);
+       sor->client.ops = &sor_client_ops;
+       sor->client.dev = &pdev->dev;
+
+       err = host1x_client_register(&sor->client);
+       if (err < 0) {
+               dev_err(&pdev->dev, "failed to register host1x client: %d\n",
+                       err);
+               return err;
+       }
+
+       platform_set_drvdata(pdev, sor);
+
+       return 0;
+}
+
+static int tegra_sor_remove(struct platform_device *pdev)
+{
+       struct tegra_sor *sor = platform_get_drvdata(pdev);
+       int err;
+
+       err = host1x_client_unregister(&sor->client);
+       if (err < 0) {
+               dev_err(&pdev->dev, "failed to unregister host1x client: %d\n",
+                       err);
+               return err;
+       }
+
+       clk_disable_unprepare(sor->clk_parent);
+       clk_disable_unprepare(sor->clk_safe);
+       clk_disable_unprepare(sor->clk_dp);
+       clk_disable_unprepare(sor->clk);
+
+       return 0;
+}
+
+static const struct of_device_id tegra_sor_of_match[] = {
+       { .compatible = "nvidia,tegra124-sor", },
+       { },
+};
+
+struct platform_driver tegra_sor_driver = {
+       .driver = {
+               .name = "tegra-sor",
+               .of_match_table = tegra_sor_of_match,
+       },
+       .probe = tegra_sor_probe,
+       .remove = tegra_sor_remove,
+};
diff --git a/drivers/gpu/drm/tegra/sor.h b/drivers/gpu/drm/tegra/sor.h
new file mode 100644 (file)
index 0000000..f4156d5
--- /dev/null
@@ -0,0 +1,278 @@
+/*
+ * Copyright (C) 2013 NVIDIA Corporation
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ */
+
+#ifndef DRM_TEGRA_SOR_H
+#define DRM_TEGRA_SOR_H
+
+#define SOR_CTXSW 0x00
+
+#define SOR_SUPER_STATE_0 0x01
+
+#define SOR_SUPER_STATE_1 0x02
+#define  SOR_SUPER_STATE_ATTACHED              (1 << 3)
+#define  SOR_SUPER_STATE_MODE_NORMAL           (1 << 2)
+#define  SOR_SUPER_STATE_HEAD_MODE_MASK                (3 << 0)
+#define  SOR_SUPER_STATE_HEAD_MODE_AWAKE       (2 << 0)
+#define  SOR_SUPER_STATE_HEAD_MODE_SNOOZE      (1 << 0)
+#define  SOR_SUPER_STATE_HEAD_MODE_SLEEP       (0 << 0)
+
+#define SOR_STATE_0 0x03
+
+#define SOR_STATE_1 0x04
+#define  SOR_STATE_ASY_PIXELDEPTH_MASK         (0xf << 17)
+#define  SOR_STATE_ASY_PIXELDEPTH_BPP_18_444   (0x2 << 17)
+#define  SOR_STATE_ASY_PIXELDEPTH_BPP_24_444   (0x5 << 17)
+#define  SOR_STATE_ASY_VSYNCPOL                        (1 << 13)
+#define  SOR_STATE_ASY_HSYNCPOL                        (1 << 12)
+#define  SOR_STATE_ASY_PROTOCOL_MASK           (0xf << 8)
+#define  SOR_STATE_ASY_PROTOCOL_CUSTOM         (0xf << 8)
+#define  SOR_STATE_ASY_PROTOCOL_DP_A           (0x8 << 8)
+#define  SOR_STATE_ASY_PROTOCOL_DP_B           (0x9 << 8)
+#define  SOR_STATE_ASY_PROTOCOL_LVDS           (0x0 << 8)
+#define  SOR_STATE_ASY_CRC_MODE_MASK           (0x3 << 6)
+#define  SOR_STATE_ASY_CRC_MODE_NON_ACTIVE     (0x2 << 6)
+#define  SOR_STATE_ASY_CRC_MODE_COMPLETE       (0x1 << 6)
+#define  SOR_STATE_ASY_CRC_MODE_ACTIVE         (0x0 << 6)
+#define  SOR_STATE_ASY_OWNER(x)                        (((x) & 0xf) << 0)
+
+#define SOR_HEAD_STATE_0(x) (0x05 + (x))
+#define SOR_HEAD_STATE_1(x) (0x07 + (x))
+#define SOR_HEAD_STATE_2(x) (0x09 + (x))
+#define SOR_HEAD_STATE_3(x) (0x0b + (x))
+#define SOR_HEAD_STATE_4(x) (0x0d + (x))
+#define SOR_HEAD_STATE_5(x) (0x0f + (x))
+#define SOR_CRC_CNTRL 0x11
+#define SOR_DP_DEBUG_MVID 0x12
+
+#define SOR_CLK_CNTRL 0x13
+#define  SOR_CLK_CNTRL_DP_LINK_SPEED_MASK      (0x1f << 2)
+#define  SOR_CLK_CNTRL_DP_LINK_SPEED(x)                (((x) & 0x1f) << 2)
+#define  SOR_CLK_CNTRL_DP_LINK_SPEED_G1_62     (0x06 << 2)
+#define  SOR_CLK_CNTRL_DP_LINK_SPEED_G2_70     (0x0a << 2)
+#define  SOR_CLK_CNTRL_DP_LINK_SPEED_G5_40     (0x14 << 2)
+#define  SOR_CLK_CNTRL_DP_CLK_SEL_MASK         (3 << 0)
+#define  SOR_CLK_CNTRL_DP_CLK_SEL_SINGLE_PCLK  (0 << 0)
+#define  SOR_CLK_CNTRL_DP_CLK_SEL_DIFF_PCLK    (1 << 0)
+#define  SOR_CLK_CNTRL_DP_CLK_SEL_SINGLE_DPCLK (2 << 0)
+#define  SOR_CLK_CNTRL_DP_CLK_SEL_DIFF_DPCLK   (3 << 0)
+
+#define SOR_CAP 0x14
+
+#define SOR_PWR 0x15
+#define  SOR_PWR_TRIGGER                       (1 << 31)
+#define  SOR_PWR_MODE_SAFE                     (1 << 28)
+#define  SOR_PWR_NORMAL_STATE_PU               (1 << 0)
+
+#define SOR_TEST 0x16
+#define  SOR_TEST_ATTACHED                     (1 << 10)
+#define  SOR_TEST_HEAD_MODE_MASK               (3 << 8)
+#define  SOR_TEST_HEAD_MODE_AWAKE              (2 << 8)
+
+#define SOR_PLL_0 0x17
+#define  SOR_PLL_0_ICHPMP_MASK                 (0xf << 24)
+#define  SOR_PLL_0_ICHPMP(x)                   (((x) & 0xf) << 24)
+#define  SOR_PLL_0_VCOCAP_MASK                 (0xf << 8)
+#define  SOR_PLL_0_VCOCAP(x)                   (((x) & 0xf) << 8)
+#define  SOR_PLL_0_VCOCAP_RST                  SOR_PLL_0_VCOCAP(3)
+#define  SOR_PLL_0_PLLREG_MASK                 (0x3 << 6)
+#define  SOR_PLL_0_PLLREG_LEVEL(x)             (((x) & 0x3) << 6)
+#define  SOR_PLL_0_PLLREG_LEVEL_V25            SOR_PLL_0_PLLREG_LEVEL(0)
+#define  SOR_PLL_0_PLLREG_LEVEL_V15            SOR_PLL_0_PLLREG_LEVEL(1)
+#define  SOR_PLL_0_PLLREG_LEVEL_V35            SOR_PLL_0_PLLREG_LEVEL(2)
+#define  SOR_PLL_0_PLLREG_LEVEL_V45            SOR_PLL_0_PLLREG_LEVEL(3)
+#define  SOR_PLL_0_PULLDOWN                    (1 << 5)
+#define  SOR_PLL_0_RESISTOR_EXT                        (1 << 4)
+#define  SOR_PLL_0_VCOPD                       (1 << 2)
+#define  SOR_PLL_0_POWER_OFF                   (1 << 0)
+
+#define SOR_PLL_1 0x18
+/* XXX: read-only bit? */
+#define  SOR_PLL_1_TERM_COMPOUT                        (1 << 15)
+#define  SOR_PLL_1_TMDS_TERM                   (1 << 8)
+
+#define SOR_PLL_2 0x19
+#define  SOR_PLL_2_LVDS_ENABLE                 (1 << 25)
+#define  SOR_PLL_2_SEQ_PLLCAPPD_ENFORCE                (1 << 24)
+#define  SOR_PLL_2_PORT_POWERDOWN              (1 << 23)
+#define  SOR_PLL_2_BANDGAP_POWERDOWN           (1 << 22)
+#define  SOR_PLL_2_POWERDOWN_OVERRIDE          (1 << 18)
+#define  SOR_PLL_2_SEQ_PLLCAPPD                        (1 << 17)
+
+#define SOR_PLL_3 0x1a
+#define  SOR_PLL_3_PLL_VDD_MODE_V1_8 (0 << 13)
+#define  SOR_PLL_3_PLL_VDD_MODE_V3_3 (1 << 13)
+
+#define SOR_CSTM 0x1b
+#define  SOR_CSTM_LVDS                         (1 << 16)
+#define  SOR_CSTM_LINK_ACT_B                   (1 << 15)
+#define  SOR_CSTM_LINK_ACT_A                   (1 << 14)
+#define  SOR_CSTM_UPPER                                (1 << 11)
+
+#define SOR_LVDS 0x1c
+#define SOR_CRC_A 0x1d
+#define SOR_CRC_B 0x1e
+#define SOR_BLANK 0x1f
+#define SOR_SEQ_CTL 0x20
+
+#define SOR_LANE_SEQ_CTL 0x21
+#define  SOR_LANE_SEQ_CTL_TRIGGER              (1 << 31)
+#define  SOR_LANE_SEQ_CTL_SEQUENCE_UP          (0 << 20)
+#define  SOR_LANE_SEQ_CTL_SEQUENCE_DOWN                (1 << 20)
+#define  SOR_LANE_SEQ_CTL_POWER_STATE_UP       (0 << 16)
+#define  SOR_LANE_SEQ_CTL_POWER_STATE_DOWN     (1 << 16)
+
+#define SOR_SEQ_INST(x) (0x22 + (x))
+
+#define SOR_PWM_DIV 0x32
+#define  SOR_PWM_DIV_MASK                      0xffffff
+
+#define SOR_PWM_CTL 0x33
+#define  SOR_PWM_CTL_TRIGGER                   (1 << 31)
+#define  SOR_PWM_CTL_CLK_SEL                   (1 << 30)
+#define  SOR_PWM_CTL_DUTY_CYCLE_MASK           0xffffff
+
+#define SOR_VCRC_A_0 0x34
+#define SOR_VCRC_A_1 0x35
+#define SOR_VCRC_B_0 0x36
+#define SOR_VCRC_B_1 0x37
+#define SOR_CCRC_A_0 0x38
+#define SOR_CCRC_A_1 0x39
+#define SOR_CCRC_B_0 0x3a
+#define SOR_CCRC_B_1 0x3b
+#define SOR_EDATA_A_0 0x3c
+#define SOR_EDATA_A_1 0x3d
+#define SOR_EDATA_B_0 0x3e
+#define SOR_EDATA_B_1 0x3f
+#define SOR_COUNT_A_0 0x40
+#define SOR_COUNT_A_1 0x41
+#define SOR_COUNT_B_0 0x42
+#define SOR_COUNT_B_1 0x43
+#define SOR_DEBUG_A_0 0x44
+#define SOR_DEBUG_A_1 0x45
+#define SOR_DEBUG_B_0 0x46
+#define SOR_DEBUG_B_1 0x47
+#define SOR_TRIG 0x48
+#define SOR_MSCHECK 0x49
+#define SOR_XBAR_CTRL 0x4a
+#define SOR_XBAR_POL 0x4b
+
+#define SOR_DP_LINKCTL_0 0x4c
+#define  SOR_DP_LINKCTL_LANE_COUNT_MASK                (0x1f << 16)
+#define  SOR_DP_LINKCTL_LANE_COUNT(x)          (((1 << (x)) - 1) << 16)
+#define  SOR_DP_LINKCTL_ENHANCED_FRAME         (1 << 14)
+#define  SOR_DP_LINKCTL_TU_SIZE_MASK           (0x7f << 2)
+#define  SOR_DP_LINKCTL_TU_SIZE(x)             (((x) & 0x7f) << 2)
+#define  SOR_DP_LINKCTL_ENABLE                 (1 << 0)
+
+#define SOR_DP_LINKCTL_1 0x4d
+
+#define SOR_LANE_DRIVE_CURRENT_0 0x4e
+#define SOR_LANE_DRIVE_CURRENT_1 0x4f
+#define SOR_LANE4_DRIVE_CURRENT_0 0x50
+#define SOR_LANE4_DRIVE_CURRENT_1 0x51
+#define  SOR_LANE_DRIVE_CURRENT_LANE3(x) (((x) & 0xff) << 24)
+#define  SOR_LANE_DRIVE_CURRENT_LANE2(x) (((x) & 0xff) << 16)
+#define  SOR_LANE_DRIVE_CURRENT_LANE1(x) (((x) & 0xff) << 8)
+#define  SOR_LANE_DRIVE_CURRENT_LANE0(x) (((x) & 0xff) << 0)
+
+#define SOR_LANE_PREEMPHASIS_0 0x52
+#define SOR_LANE_PREEMPHASIS_1 0x53
+#define SOR_LANE4_PREEMPHASIS_0 0x54
+#define SOR_LANE4_PREEMPHASIS_1 0x55
+#define  SOR_LANE_PREEMPHASIS_LANE3(x) (((x) & 0xff) << 24)
+#define  SOR_LANE_PREEMPHASIS_LANE2(x) (((x) & 0xff) << 16)
+#define  SOR_LANE_PREEMPHASIS_LANE1(x) (((x) & 0xff) << 8)
+#define  SOR_LANE_PREEMPHASIS_LANE0(x) (((x) & 0xff) << 0)
+
+#define SOR_LANE_POST_CURSOR_0 0x56
+#define SOR_LANE_POST_CURSOR_1 0x57
+#define  SOR_LANE_POST_CURSOR_LANE3(x) (((x) & 0xff) << 24)
+#define  SOR_LANE_POST_CURSOR_LANE2(x) (((x) & 0xff) << 16)
+#define  SOR_LANE_POST_CURSOR_LANE1(x) (((x) & 0xff) << 8)
+#define  SOR_LANE_POST_CURSOR_LANE0(x) (((x) & 0xff) << 0)
+
+#define SOR_DP_CONFIG_0 0x58
+#define SOR_DP_CONFIG_DISPARITY_NEGATIVE       (1 << 31)
+#define SOR_DP_CONFIG_ACTIVE_SYM_ENABLE                (1 << 26)
+#define SOR_DP_CONFIG_ACTIVE_SYM_POLARITY      (1 << 24)
+#define SOR_DP_CONFIG_ACTIVE_SYM_FRAC_MASK     (0xf << 16)
+#define SOR_DP_CONFIG_ACTIVE_SYM_FRAC(x)       (((x) & 0xf) << 16)
+#define SOR_DP_CONFIG_ACTIVE_SYM_COUNT_MASK    (0x7f << 8)
+#define SOR_DP_CONFIG_ACTIVE_SYM_COUNT(x)      (((x) & 0x7f) << 8)
+#define SOR_DP_CONFIG_WATERMARK_MASK   (0x3f << 0)
+#define SOR_DP_CONFIG_WATERMARK(x)     (((x) & 0x3f) << 0)
+
+#define SOR_DP_CONFIG_1 0x59
+#define SOR_DP_MN_0 0x5a
+#define SOR_DP_MN_1 0x5b
+
+#define SOR_DP_PADCTL_0 0x5c
+#define  SOR_DP_PADCTL_PAD_CAL_PD      (1 << 23)
+#define  SOR_DP_PADCTL_TX_PU_ENABLE    (1 << 22)
+#define  SOR_DP_PADCTL_TX_PU_MASK      (0xff << 8)
+#define  SOR_DP_PADCTL_TX_PU(x)                (((x) & 0xff) << 8)
+#define  SOR_DP_PADCTL_CM_TXD_3                (1 << 7)
+#define  SOR_DP_PADCTL_CM_TXD_2                (1 << 6)
+#define  SOR_DP_PADCTL_CM_TXD_1                (1 << 5)
+#define  SOR_DP_PADCTL_CM_TXD_0                (1 << 4)
+#define  SOR_DP_PADCTL_PD_TXD_3                (1 << 3)
+#define  SOR_DP_PADCTL_PD_TXD_0                (1 << 2)
+#define  SOR_DP_PADCTL_PD_TXD_1                (1 << 1)
+#define  SOR_DP_PADCTL_PD_TXD_2                (1 << 0)
+
+#define SOR_DP_PADCTL_1 0x5d
+
+#define SOR_DP_DEBUG_0 0x5e
+#define SOR_DP_DEBUG_1 0x5f
+
+#define SOR_DP_SPARE_0 0x60
+#define  SOR_DP_SPARE_MACRO_SOR_CLK    (1 << 2)
+#define  SOR_DP_SPARE_PANEL_INTERNAL   (1 << 1)
+#define  SOR_DP_SPARE_SEQ_ENABLE       (1 << 0)
+
+#define SOR_DP_SPARE_1 0x61
+#define SOR_DP_AUDIO_CTRL 0x62
+
+#define SOR_DP_AUDIO_HBLANK_SYMBOLS 0x63
+#define SOR_DP_AUDIO_HBLANK_SYMBOLS_MASK (0x01ffff << 0)
+
+#define SOR_DP_AUDIO_VBLANK_SYMBOLS 0x64
+#define SOR_DP_AUDIO_VBLANK_SYMBOLS_MASK (0x1fffff << 0)
+
+#define SOR_DP_GENERIC_INFOFRAME_HEADER 0x65
+#define SOR_DP_GENERIC_INFOFRAME_SUBPACK_0 0x66
+#define SOR_DP_GENERIC_INFOFRAME_SUBPACK_1 0x67
+#define SOR_DP_GENERIC_INFOFRAME_SUBPACK_2 0x68
+#define SOR_DP_GENERIC_INFOFRAME_SUBPACK_3 0x69
+#define SOR_DP_GENERIC_INFOFRAME_SUBPACK_4 0x6a
+#define SOR_DP_GENERIC_INFOFRAME_SUBPACK_5 0x6b
+#define SOR_DP_GENERIC_INFOFRAME_SUBPACK_6 0x6c
+
+#define SOR_DP_TPG 0x6d
+#define  SOR_DP_TPG_CHANNEL_CODING     (1 << 6)
+#define  SOR_DP_TPG_SCRAMBLER_MASK     (3 << 4)
+#define  SOR_DP_TPG_SCRAMBLER_FIBONACCI        (2 << 4)
+#define  SOR_DP_TPG_SCRAMBLER_GALIOS   (1 << 4)
+#define  SOR_DP_TPG_SCRAMBLER_NONE     (0 << 4)
+#define  SOR_DP_TPG_PATTERN_MASK       (0xf << 0)
+#define  SOR_DP_TPG_PATTERN_HBR2       (0x8 << 0)
+#define  SOR_DP_TPG_PATTERN_CSTM       (0x7 << 0)
+#define  SOR_DP_TPG_PATTERN_PRBS7      (0x6 << 0)
+#define  SOR_DP_TPG_PATTERN_SBLERRRATE (0x5 << 0)
+#define  SOR_DP_TPG_PATTERN_D102       (0x4 << 0)
+#define  SOR_DP_TPG_PATTERN_TRAIN3     (0x3 << 0)
+#define  SOR_DP_TPG_PATTERN_TRAIN2     (0x2 << 0)
+#define  SOR_DP_TPG_PATTERN_TRAIN1     (0x1 << 0)
+#define  SOR_DP_TPG_PATTERN_NONE       (0x0 << 0)
+
+#define SOR_DP_TPG_CONFIG 0x6e
+#define SOR_DP_LQ_CSTM_0 0x6f
+#define SOR_DP_LQ_CSTM_1 0x70
+#define SOR_DP_LQ_CSTM_2 0x71
+
+#endif