Signed-off-by: Thierry Reding <treding at nvidia.com>
---
drivers/gpu/drm/tegra/dsi.c | 147 ++++++++++++++++++++++++++++++++++++++++++++
1 file changed, 147 insertions(+)
diff --git a/drivers/gpu/drm/tegra/dsi.c b/drivers/gpu/drm/tegra/dsi.c
index effd0b5a5554..a100719b3d0c 100644
--- a/drivers/gpu/drm/tegra/dsi.c
+++ b/drivers/gpu/drm/tegra/dsi.c
@@ -774,6 +774,131 @@ static void tegra_dsi_initialize(struct tegra_dsi *dsi)
tegra_dsi_writel(dsi, 0, DSI_GANGED_MODE_SIZE);
}
+static int tegra_dsi_set_lp_clk(struct tegra_dsi *dsi, unsigned long pclk)
+{
+ unsigned long bclk, timeout, value;
+ struct clk *clk, *parent, *base;
+ unsigned int mul, div;
+ int err;
+
+ err = tegra_dsi_get_muldiv(dsi->format, &mul, &div);
+ if (err < 0)
+ return err;
+
+ bclk = pclk * 8;
+
+ clk = clk_get_parent(dsi->clk);
+ parent = clk_get_parent(clk);
+ base = clk_get_parent(parent);
+
+ err = clk_set_rate(base, pclk * 2);
+ if (err < 0)
+ return err;
+
+ /* one frame high-speed transmission timeout */
+ timeout = bclk / 512;
+ value = DSI_TIMEOUT_LRX(0x2000) | DSI_TIMEOUT_HTX(timeout);
+ tegra_dsi_writel(dsi, value, DSI_TIMEOUT_0);
+
+ /* 2 ms peripheral timeout for panel */
+ timeout = 2 * bclk / 512 * 1000;
+ value = DSI_TIMEOUT_PR(timeout) | DSI_TIMEOUT_TA(0x2000);
+ tegra_dsi_writel(dsi, value, DSI_TIMEOUT_1);
+
+ value = DSI_TALLY_TA(0) | DSI_TALLY_LRX(0) | DSI_TALLY_HTX(0);
+ tegra_dsi_writel(dsi, value, DSI_TO_TALLY);
+
+ return 0;
+}
+
+static ssize_t tegra_dsi_host_transfer(struct dsi_host *host,
+ struct dsi_msg *msg)
+{
+ struct tegra_dsi *dsi = dsi_host_to_tegra(host);
+ unsigned long value, timeout;
+ unsigned int count = 0, i;
+ const u8 *tx = msg->tx;
+ int err;
+
+ dev_info(dsi->dev, "> %s(host=%p, msg=%p)\n", __func__, host, msg);
+
+ /* XXX */
+ drm_panel_enable(dsi->output.panel);
+
+ value = tegra_dsi_readl(dsi, DSI_POWER_CONTROL);
+ value |= DSI_POWER_CONTROL_ENABLE;
+ tegra_dsi_writel(dsi, value, DSI_POWER_CONTROL);
+ usleep_range(300, 1000);
+
+ err = tegra_dsi_set_lp_clk(dsi, 10000000);
+ if (err < 0) {
+ dev_err(dsi->dev, "failed to setup low-power clock: %d\n", err);
+ return err;
+ }
+
+ tegra_dsi_writel(dsi, DSI_HOST_FIFO_DEPTH, DSI_MAX_THRESHOLD);
+
+ value = tegra_dsi_readl(dsi, DSI_CONTROL);
+ value = 0x00003031;
+ tegra_dsi_writel(dsi, value, DSI_CONTROL);
+
+ value = tegra_dsi_readl(dsi, DSI_HOST_CONTROL);
+ value = 0x00102003;
+ tegra_dsi_writel(dsi, value, DSI_HOST_CONTROL);
+
+ if (msg->rx && msg->rx_len > 0) {
+ value = tegra_dsi_readl(dsi, DSI_HOST_CONTROL);
+ value |= DSI_HOST_CONTROL_BTA;
+ tegra_dsi_writel(dsi, value, DSI_HOST_CONTROL);
+ }
+
+ value = ((msg->channel & 0x3) << 6) | (msg->type & 0x3f);
+
+ value |= tx[0] << 8;
+ value |= tx[1] << 16;
+
+ tegra_dsi_writel(dsi, value, DSI_WR_DATA);
+
+ tegra_dsi_writel(dsi, 0x00000002, DSI_TRIGGER);
+
+ timeout = jiffies + msecs_to_jiffies(250);
+
+ while (true) {
+ value = tegra_dsi_readl(dsi, DSI_TRIGGER);
+ if ((value & 0x00000002) == 0)
+ break;
+
+ if (time_after(jiffies, timeout))
+ return -ETIMEDOUT;
+
+ usleep_range(25, 100);
+ }
+
+ timeout = jiffies + msecs_to_jiffies(250);
+
+ while (true) {
+ usleep_range(1000, 2000);
+
+ value = tegra_dsi_readl(dsi, DSI_STATUS);
+ count = value & 0x1f;
+
+ if (count > 0)
+ break;
+
+ if (time_after(jiffies, timeout))
+ return -ETIMEDOUT;
+ }
+
+ for (i = 0; i < count; i++)
+ tegra_dsi_readl(dsi, DSI_RD_DATA);
+
+ /* XXX */
+ drm_panel_disable(dsi->output.panel);
+
+ dev_info(dsi->dev, "< %s()\n", __func__);
+ return 0;
+}
+
static int tegra_dsi_host_attach(struct dsi_host *host,
struct dsi_device *device)
{
@@ -784,6 +909,27 @@ static int tegra_dsi_host_attach(struct dsi_host *host,
if (output->panel) {
if (output->connector.dev)
drm_helper_hpd_irq_event(output->connector.dev);
+
+ if (0) {
+ struct dsi_msg msg;
+ u8 tx[2], rx[2];
+ ssize_t err;
+
+ rx[0] = rx[1] = 0;
+ tx[0] = tx[1] = 0;
+
+ memset(&msg, 0, sizeof(msg));
+ msg.channel = 0;
+ msg.type = 0x05;
+ msg.tx_len = 2;
+ msg.tx = tx;
+ msg.rx_len = 2;
+ msg.rx = rx;
+
+ err = dsi_host_transfer(&dsi->host, &msg);
+ if (err < 0)
+ dev_err(dsi->dev, "dsi_host_transfer() failed:
%zd\n", err);
+ }
}
return 0;
@@ -808,6 +954,7 @@ static int tegra_dsi_host_detach(struct dsi_host *host,
static const struct dsi_host_ops tegra_dsi_host_ops = {
.attach = tegra_dsi_host_attach,
.detach = tegra_dsi_host_detach,
+ .transfer = tegra_dsi_host_transfer,
};
static int tegra_dsi_probe(struct platform_device *pdev)
--
1.8.4.2
