1 files changed, 574 insertions, 0 deletions

diff --git a/drivers/video/fbdev/exynos/exynos_mipi_dsi.c b/drivers/video/fbdev/exynos/exynos_mipi_dsi.c
new file mode 100644
index 000000000000..cee9602f9a7b
--- /dev/null
+++ b/drivers/video/fbdev/exynos/exynos_mipi_dsi.c
@@ -0,0 +1,574 @@
+/* linux/drivers/video/exynos/exynos_mipi_dsi.c
+ *
+ * Samsung SoC MIPI-DSIM driver.
+ *
+ * Copyright (c) 2012 Samsung Electronics Co., Ltd
+ *
+ * InKi Dae, <inki.dae@samsung.com>
+ * Donghwa Lee, <dh09.lee@samsung.com>
+ *
+ * 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/module.h>
+#include <linux/kernel.h>
+#include <linux/errno.h>
+#include <linux/clk.h>
+#include <linux/mutex.h>
+#include <linux/wait.h>
+#include <linux/fs.h>
+#include <linux/mm.h>
+#include <linux/fb.h>
+#include <linux/ctype.h>
+#include <linux/platform_device.h>
+#include <linux/io.h>
+#include <linux/irq.h>
+#include <linux/memory.h>
+#include <linux/delay.h>
+#include <linux/interrupt.h>
+#include <linux/kthread.h>
+#include <linux/notifier.h>
+#include <linux/phy/phy.h>
+#include <linux/regulator/consumer.h>
+#include <linux/pm_runtime.h>
+#include <linux/err.h>
+
+#include <video/exynos_mipi_dsim.h>
+
+#include "exynos_mipi_dsi_common.h"
+#include "exynos_mipi_dsi_lowlevel.h"
+
+struct mipi_dsim_ddi {
+        int                             bus_id;
+        struct list_head                list;
+        struct mipi_dsim_lcd_device     *dsim_lcd_dev;
+        struct mipi_dsim_lcd_driver     *dsim_lcd_drv;
+};
+
+static LIST_HEAD(dsim_ddi_list);
+
+static DEFINE_MUTEX(mipi_dsim_lock);
+
+static struct mipi_dsim_platform_data *to_dsim_plat(struct platform_device
+                                                        *pdev)
+{
+        return pdev->dev.platform_data;
+}
+
+static struct regulator_bulk_data supplies[] = {
+        { .supply = "vdd11", },
+        { .supply = "vdd18", },
+};
+
+static int exynos_mipi_regulator_enable(struct mipi_dsim_device *dsim)
+{
+        int ret;
+
+        mutex_lock(&dsim->lock);
+        ret = regulator_bulk_enable(ARRAY_SIZE(supplies), supplies);
+        mutex_unlock(&dsim->lock);
+
+        return ret;
+}
+
+static int exynos_mipi_regulator_disable(struct mipi_dsim_device *dsim)
+{
+        int ret;
+
+        mutex_lock(&dsim->lock);
+        ret = regulator_bulk_disable(ARRAY_SIZE(supplies), supplies);
+        mutex_unlock(&dsim->lock);
+
+        return ret;
+}
+
+/* update all register settings to MIPI DSI controller. */
+static void exynos_mipi_update_cfg(struct mipi_dsim_device *dsim)
+{
+        /*
+         * data from Display controller(FIMD) is not transferred in video mode
+         * but in case of command mode, all settings is not updated to
+         * registers.
+         */
+        exynos_mipi_dsi_stand_by(dsim, 0);
+
+        exynos_mipi_dsi_init_dsim(dsim);
+        exynos_mipi_dsi_init_link(dsim);
+
+        exynos_mipi_dsi_set_hs_enable(dsim);
+
+        /* set display timing. */
+        exynos_mipi_dsi_set_display_mode(dsim, dsim->dsim_config);
+
+        exynos_mipi_dsi_init_interrupt(dsim);
+
+        /*
+         * data from Display controller(FIMD) is transferred in video mode
+         * but in case of command mode, all settings are updated to registers.
+         */
+        exynos_mipi_dsi_stand_by(dsim, 1);
+}
+
+static int exynos_mipi_dsi_early_blank_mode(struct mipi_dsim_device *dsim,
+                int power)
+{
+        struct mipi_dsim_lcd_driver *client_drv = dsim->dsim_lcd_drv;
+        struct mipi_dsim_lcd_device *client_dev = dsim->dsim_lcd_dev;
+
+        switch (power) {
+        case FB_BLANK_POWERDOWN:
+                if (dsim->suspended)
+                        return 0;
+
+                if (client_drv && client_drv->suspend)
+                        client_drv->suspend(client_dev);
+
+                clk_disable(dsim->clock);
+
+                exynos_mipi_regulator_disable(dsim);
+
+                dsim->suspended = true;
+
+                break;
+        default:
+                break;
+        }
+
+        return 0;
+}
+
+static int exynos_mipi_dsi_blank_mode(struct mipi_dsim_device *dsim, int power)
+{
+        struct mipi_dsim_lcd_driver *client_drv = dsim->dsim_lcd_drv;
+        struct mipi_dsim_lcd_device *client_dev = dsim->dsim_lcd_dev;
+
+        switch (power) {
+        case FB_BLANK_UNBLANK:
+                if (!dsim->suspended)
+                        return 0;
+
+                /* lcd panel power on. */
+                if (client_drv && client_drv->power_on)
+                        client_drv->power_on(client_dev, 1);
+
+                exynos_mipi_regulator_enable(dsim);
+
+                /* enable MIPI-DSI PHY. */
+                phy_power_on(dsim->phy);
+
+                clk_enable(dsim->clock);
+
+                exynos_mipi_update_cfg(dsim);
+
+                /* set lcd panel sequence commands. */
+                if (client_drv && client_drv->set_sequence)
+                        client_drv->set_sequence(client_dev);
+
+                dsim->suspended = false;
+
+                break;
+        case FB_BLANK_NORMAL:
+                /* TODO. */
+                break;
+        default:
+                break;
+        }
+
+        return 0;
+}
+
+int exynos_mipi_dsi_register_lcd_device(struct mipi_dsim_lcd_device *lcd_dev)
+{
+        struct mipi_dsim_ddi *dsim_ddi;
+
+        if (!lcd_dev->name) {
+                pr_err("dsim_lcd_device name is NULL.\n");
+                return -EFAULT;
+        }
+
+        dsim_ddi = kzalloc(sizeof(struct mipi_dsim_ddi), GFP_KERNEL);
+        if (!dsim_ddi) {
+                pr_err("failed to allocate dsim_ddi object.\n");
+                return -ENOMEM;
+        }
+
+        dsim_ddi->dsim_lcd_dev = lcd_dev;
+
+        mutex_lock(&mipi_dsim_lock);
+        list_add_tail(&dsim_ddi->list, &dsim_ddi_list);
+        mutex_unlock(&mipi_dsim_lock);
+
+        return 0;
+}
+
+static struct mipi_dsim_ddi *exynos_mipi_dsi_find_lcd_device(
+                                        struct mipi_dsim_lcd_driver *lcd_drv)
+{
+        struct mipi_dsim_ddi *dsim_ddi, *next;
+        struct mipi_dsim_lcd_device *lcd_dev;
+
+        mutex_lock(&mipi_dsim_lock);
+
+        list_for_each_entry_safe(dsim_ddi, next, &dsim_ddi_list, list) {
+                if (!dsim_ddi)
+                        goto out;
+
+                lcd_dev = dsim_ddi->dsim_lcd_dev;
+                if (!lcd_dev)
+                        continue;
+
+                if ((strcmp(lcd_drv->name, lcd_dev->name)) == 0) {
+                        /**
+                         * bus_id would be used to identify
+                         * connected bus.
+                         */
+                        dsim_ddi->bus_id = lcd_dev->bus_id;
+                        mutex_unlock(&mipi_dsim_lock);
+
+                        return dsim_ddi;
+                }
+
+                list_del(&dsim_ddi->list);
+                kfree(dsim_ddi);
+        }
+
+out:
+        mutex_unlock(&mipi_dsim_lock);
+
+        return NULL;
+}
+
+int exynos_mipi_dsi_register_lcd_driver(struct mipi_dsim_lcd_driver *lcd_drv)
+{
+        struct mipi_dsim_ddi *dsim_ddi;
+
+        if (!lcd_drv->name) {
+                pr_err("dsim_lcd_driver name is NULL.\n");
+                return -EFAULT;
+        }
+
+        dsim_ddi = exynos_mipi_dsi_find_lcd_device(lcd_drv);
+        if (!dsim_ddi) {
+                pr_err("mipi_dsim_ddi object not found.\n");
+                return -EFAULT;
+        }
+
+        dsim_ddi->dsim_lcd_drv = lcd_drv;
+
+        pr_info("registered panel driver(%s) to mipi-dsi driver.\n",
+                lcd_drv->name);
+
+        return 0;
+
+}
+
+static struct mipi_dsim_ddi *exynos_mipi_dsi_bind_lcd_ddi(
+                                                struct mipi_dsim_device *dsim,
+                                                const char *name)
+{
+        struct mipi_dsim_ddi *dsim_ddi, *next;
+        struct mipi_dsim_lcd_driver *lcd_drv;
+        struct mipi_dsim_lcd_device *lcd_dev;
+        int ret;
+
+        mutex_lock(&dsim->lock);
+
+        list_for_each_entry_safe(dsim_ddi, next, &dsim_ddi_list, list) {
+                lcd_drv = dsim_ddi->dsim_lcd_drv;
+                lcd_dev = dsim_ddi->dsim_lcd_dev;
+                if (!lcd_drv || !lcd_dev ||
+                        (dsim->id != dsim_ddi->bus_id))
+                                continue;
+
+                dev_dbg(dsim->dev, "lcd_drv->id = %d, lcd_dev->id = %d\n",
+                                lcd_drv->id, lcd_dev->id);
+                dev_dbg(dsim->dev, "lcd_dev->bus_id = %d, dsim->id = %d\n",
+                                lcd_dev->bus_id, dsim->id);
+
+                if ((strcmp(lcd_drv->name, name) == 0)) {
+                        lcd_dev->master = dsim;
+
+                        lcd_dev->dev.parent = dsim->dev;
+                        dev_set_name(&lcd_dev->dev, "%s", lcd_drv->name);
+
+                        ret = device_register(&lcd_dev->dev);
+                        if (ret < 0) {
+                                dev_err(dsim->dev,
+                                        "can't register %s, status %d\n",
+                                        dev_name(&lcd_dev->dev), ret);
+                                mutex_unlock(&dsim->lock);
+
+                                return NULL;
+                        }
+
+                        dsim->dsim_lcd_dev = lcd_dev;
+                        dsim->dsim_lcd_drv = lcd_drv;
+
+                        mutex_unlock(&dsim->lock);
+
+                        return dsim_ddi;
+                }
+        }
+
+        mutex_unlock(&dsim->lock);
+
+        return NULL;
+}
+
+/* define MIPI-DSI Master operations. */
+static struct mipi_dsim_master_ops master_ops = {
+        .cmd_read                       = exynos_mipi_dsi_rd_data,
+        .cmd_write                      = exynos_mipi_dsi_wr_data,
+        .get_dsim_frame_done            = exynos_mipi_dsi_get_frame_done_status,
+        .clear_dsim_frame_done          = exynos_mipi_dsi_clear_frame_done,
+        .set_early_blank_mode           = exynos_mipi_dsi_early_blank_mode,
+        .set_blank_mode                 = exynos_mipi_dsi_blank_mode,
+};
+
+static int exynos_mipi_dsi_probe(struct platform_device *pdev)
+{
+        struct resource *res;
+        struct mipi_dsim_device *dsim;
+        struct mipi_dsim_config *dsim_config;
+        struct mipi_dsim_platform_data *dsim_pd;
+        struct mipi_dsim_ddi *dsim_ddi;
+        int ret = -EINVAL;
+
+        dsim = devm_kzalloc(&pdev->dev, sizeof(struct mipi_dsim_device),
+                                GFP_KERNEL);
+        if (!dsim) {
+                dev_err(&pdev->dev, "failed to allocate dsim object.\n");
+                return -ENOMEM;
+        }
+
+        dsim->pd = to_dsim_plat(pdev);
+        dsim->dev = &pdev->dev;
+        dsim->id = pdev->id;
+
+        /* get mipi_dsim_platform_data. */
+        dsim_pd = (struct mipi_dsim_platform_data *)dsim->pd;
+        if (dsim_pd == NULL) {
+                dev_err(&pdev->dev, "failed to get platform data for dsim.\n");
+                return -EINVAL;
+        }
+        /* get mipi_dsim_config. */
+        dsim_config = dsim_pd->dsim_config;
+        if (dsim_config == NULL) {
+                dev_err(&pdev->dev, "failed to get dsim config data.\n");
+                return -EINVAL;
+        }
+
+        dsim->dsim_config = dsim_config;
+        dsim->master_ops = &master_ops;
+
+        mutex_init(&dsim->lock);
+
+        ret = devm_regulator_bulk_get(&pdev->dev, ARRAY_SIZE(supplies),
+                                        supplies);
+        if (ret) {
+                dev_err(&pdev->dev, "Failed to get regulators: %d\n", ret);
+                return ret;
+        }
+
+        dsim->phy = devm_phy_get(&pdev->dev, "dsim");
+        if (IS_ERR(dsim->phy))
+                return PTR_ERR(dsim->phy);
+
+        dsim->clock = devm_clk_get(&pdev->dev, "dsim0");
+        if (IS_ERR(dsim->clock)) {
+                dev_err(&pdev->dev, "failed to get dsim clock source\n");
+                return -ENODEV;
+        }
+
+        clk_enable(dsim->clock);
+
+        res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+
+        dsim->reg_base = devm_ioremap_resource(&pdev->dev, res);
+        if (IS_ERR(dsim->reg_base)) {
+                ret = PTR_ERR(dsim->reg_base);
+                goto error;
+        }
+
+        mutex_init(&dsim->lock);
+
+        /* bind lcd ddi matched with panel name. */
+        dsim_ddi = exynos_mipi_dsi_bind_lcd_ddi(dsim, dsim_pd->lcd_panel_name);
+        if (!dsim_ddi) {
+                dev_err(&pdev->dev, "mipi_dsim_ddi object not found.\n");
+                ret = -EINVAL;
+                goto error;
+        }
+
+        dsim->irq = platform_get_irq(pdev, 0);
+        if (IS_ERR_VALUE(dsim->irq)) {
+                dev_err(&pdev->dev, "failed to request dsim irq resource\n");
+                ret = -EINVAL;
+                goto error;
+        }
+
+        init_completion(&dsim_wr_comp);
+        init_completion(&dsim_rd_comp);
+        platform_set_drvdata(pdev, dsim);
+
+        ret = devm_request_irq(&pdev->dev, dsim->irq,
+                        exynos_mipi_dsi_interrupt_handler,
+                        IRQF_SHARED, dev_name(&pdev->dev), dsim);
+        if (ret != 0) {
+                dev_err(&pdev->dev, "failed to request dsim irq\n");
+                ret = -EINVAL;
+                goto error;
+        }
+
+        /* enable interrupts */
+        exynos_mipi_dsi_init_interrupt(dsim);
+
+        /* initialize mipi-dsi client(lcd panel). */
+        if (dsim_ddi->dsim_lcd_drv && dsim_ddi->dsim_lcd_drv->probe)
+                dsim_ddi->dsim_lcd_drv->probe(dsim_ddi->dsim_lcd_dev);
+
+        /* in case mipi-dsi has been enabled by bootloader */
+        if (dsim_pd->enabled) {
+                exynos_mipi_regulator_enable(dsim);
+                goto done;
+        }
+
+        /* lcd panel power on. */
+        if (dsim_ddi->dsim_lcd_drv && dsim_ddi->dsim_lcd_drv->power_on)
+                dsim_ddi->dsim_lcd_drv->power_on(dsim_ddi->dsim_lcd_dev, 1);
+
+        exynos_mipi_regulator_enable(dsim);
+
+        /* enable MIPI-DSI PHY. */
+        phy_power_on(dsim->phy);
+
+        exynos_mipi_update_cfg(dsim);
+
+        /* set lcd panel sequence commands. */
+        if (dsim_ddi->dsim_lcd_drv && dsim_ddi->dsim_lcd_drv->set_sequence)
+                dsim_ddi->dsim_lcd_drv->set_sequence(dsim_ddi->dsim_lcd_dev);
+
+        dsim->suspended = false;
+
+done:
+        platform_set_drvdata(pdev, dsim);
+
+        dev_dbg(&pdev->dev, "%s() completed successfully (%s mode)\n", __func__,
+                dsim_config->e_interface == DSIM_COMMAND ? "CPU" : "RGB");
+
+        return 0;
+
+error:
+        clk_disable(dsim->clock);
+        return ret;
+}
+
+static int exynos_mipi_dsi_remove(struct platform_device *pdev)
+{
+        struct mipi_dsim_device *dsim = platform_get_drvdata(pdev);
+        struct mipi_dsim_ddi *dsim_ddi, *next;
+        struct mipi_dsim_lcd_driver *dsim_lcd_drv;
+
+        clk_disable(dsim->clock);
+
+        list_for_each_entry_safe(dsim_ddi, next, &dsim_ddi_list, list) {
+                if (dsim_ddi) {
+                        if (dsim->id != dsim_ddi->bus_id)
+                                continue;
+
+                        dsim_lcd_drv = dsim_ddi->dsim_lcd_drv;
+
+                        if (dsim_lcd_drv->remove)
+                                dsim_lcd_drv->remove(dsim_ddi->dsim_lcd_dev);
+
+                        kfree(dsim_ddi);
+                }
+        }
+
+        return 0;
+}
+
+#ifdef CONFIG_PM_SLEEP
+static int exynos_mipi_dsi_suspend(struct device *dev)
+{
+        struct platform_device *pdev = to_platform_device(dev);
+        struct mipi_dsim_device *dsim = platform_get_drvdata(pdev);
+        struct mipi_dsim_lcd_driver *client_drv = dsim->dsim_lcd_drv;
+        struct mipi_dsim_lcd_device *client_dev = dsim->dsim_lcd_dev;
+
+        disable_irq(dsim->irq);
+
+        if (dsim->suspended)
+                return 0;
+
+        if (client_drv && client_drv->suspend)
+                client_drv->suspend(client_dev);
+
+        /* disable MIPI-DSI PHY. */
+        phy_power_off(dsim->phy);
+
+        clk_disable(dsim->clock);
+
+        exynos_mipi_regulator_disable(dsim);
+
+        dsim->suspended = true;
+
+        return 0;
+}
+
+static int exynos_mipi_dsi_resume(struct device *dev)
+{
+        struct platform_device *pdev = to_platform_device(dev);
+        struct mipi_dsim_device *dsim = platform_get_drvdata(pdev);
+        struct mipi_dsim_lcd_driver *client_drv = dsim->dsim_lcd_drv;
+        struct mipi_dsim_lcd_device *client_dev = dsim->dsim_lcd_dev;
+
+        enable_irq(dsim->irq);
+
+        if (!dsim->suspended)
+                return 0;
+
+        /* lcd panel power on. */
+        if (client_drv && client_drv->power_on)
+                client_drv->power_on(client_dev, 1);
+
+        exynos_mipi_regulator_enable(dsim);
+
+        /* enable MIPI-DSI PHY. */
+        phy_power_on(dsim->phy);
+
+        clk_enable(dsim->clock);
+
+        exynos_mipi_update_cfg(dsim);
+
+        /* set lcd panel sequence commands. */
+        if (client_drv && client_drv->set_sequence)
+                client_drv->set_sequence(client_dev);
+
+        dsim->suspended = false;
+
+        return 0;
+}
+#endif
+
+static const struct dev_pm_ops exynos_mipi_dsi_pm_ops = {
+        SET_SYSTEM_SLEEP_PM_OPS(exynos_mipi_dsi_suspend, exynos_mipi_dsi_resume)
+};
+
+static struct platform_driver exynos_mipi_dsi_driver = {
+        .probe = exynos_mipi_dsi_probe,
+        .remove = exynos_mipi_dsi_remove,
+        .driver = {
+                   .name = "exynos-mipi-dsim",
+                   .owner = THIS_MODULE,
+                   .pm = &exynos_mipi_dsi_pm_ops,
+        },
+};
+
+module_platform_driver(exynos_mipi_dsi_driver);
+
+MODULE_AUTHOR("InKi Dae <inki.dae@samsung.com>");
+MODULE_DESCRIPTION("Samusung SoC MIPI-DSI driver");
+MODULE_LICENSE("GPL");