[COMMON] usi_v2: USI version2 configuration driver.

Change-Id: I4bbb7654cfa6d3503a02f0a6239544713eeaaadb
Signed-off-by: Youngmin Nam <youngmin.nam@samsung.com>
Signed-off-by: Kyungwoo Kang <kwoo.kang@samsung.com>

diff --git a/drivers/soc/samsung/usi_v2.c b/drivers/soc/samsung/usi_v2.c
new file mode 100644 (file)
index 0000000..71f01b9
--- /dev/null
+++ b/drivers/soc/samsung/usi_v2.c
@@ -0,0 +1,150 @@
+/*
+ * Copyright (c) 2017 Samsung Electronics Co., Ltd.
+ *              http://www.samsung.com/
+ *
+ * EXYNOS - USI v2(Universal Serial Interface version 2) driver.
+ *
+ * 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/err.h>
+#include <linux/io.h>
+#include <linux/module.h>
+#include <linux/of.h>
+#include <linux/platform_device.h>
+
+/* USI v2 mode */
+#define I2C_SW_CONF            (1<<2)
+#define SPI_SW_CONF            (1<<1)
+#define UART_SW_CONF           (1<<0)
+
+struct usi_v2_mode {
+       int val;
+       const char *name;
+};
+
+struct usi_v2_data {
+       void __iomem    *base;
+       int             mode;
+       int             ch_id;
+};
+
+static const struct usi_v2_mode usi_v2_modes[] = {
+       { .val = I2C_SW_CONF ,     .name = "i2c" },
+       { .val = SPI_SW_CONF ,     .name = "spi" },
+       { .val = UART_SW_CONF ,    .name = "uart" },
+};
+
+static int get_usi_v2_mode(const char* mode_name)
+{
+       int i;
+
+       for (i = 0; i < sizeof(usi_v2_modes)/sizeof(struct usi_v2_mode); i++) {
+               if (!strncmp(mode_name, usi_v2_modes[i].name,
+                               strlen(usi_v2_modes[i].name)))
+                       return usi_v2_modes[i].val;
+       }
+       return -1;
+}
+
+static int usi_v2_probe(struct platform_device *pdev)
+{
+       struct device_node *node = pdev->dev.of_node;
+       struct resource *res;
+       const char* mode_name;
+       struct usi_v2_data *data;
+
+       data = devm_kzalloc(&pdev->dev, sizeof(struct usi_v2_data), GFP_KERNEL);
+       if (!data) {
+               dev_err(&pdev->dev, "no memory to save usi_v2_data\n");
+               return -ENOMEM;
+       }
+
+       data->ch_id = of_alias_get_id(pdev->dev.of_node, "usi_v2");
+
+       res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+       data->base = devm_ioremap_resource(&pdev->dev, res);
+       if (IS_ERR(data->base))
+               return PTR_ERR(data->base);
+
+       if (of_property_read_string(node, "usi_v2_mode", &mode_name) < 0) {
+               dev_err(&pdev->dev, "missing usi_v2 mode configuration\n");
+               return -EINVAL;
+       }
+
+       data->mode = get_usi_v2_mode(mode_name);
+
+       if (data->mode < 0) {
+               dev_err(&pdev->dev, "wrong usi_v2 mode: %s\n", mode_name);
+               return -EINVAL;
+       }
+
+       platform_set_drvdata(pdev, data);
+
+       writel(data->mode, data->base);
+
+       dev_info(&pdev->dev, "usi_v2_probe() mode:%d\n", data->mode);
+
+       return 0;
+}
+
+static const struct of_device_id usi_v2_dt_match[] = {
+       { .compatible = "samsung,exynos-usi-v2", },
+       { },
+};
+
+MODULE_DEVICE_TABLE(of, usi_v2_dt_match);
+
+static int usi_v2_resume_noirq(struct device *dev)
+{
+       struct platform_device *pdev = to_platform_device(dev);
+       struct usi_v2_data *data = platform_get_drvdata(pdev);
+       int ret;
+
+       if (data->mode && data->base) {
+               writel(data->mode, data->base);
+               dev_info(&pdev->dev, "%s mode:%d\n", __func__, data->mode);
+               ret = 0;
+       } else {
+               dev_err(&pdev->dev, "%s wrong usi_v2 data\n", __func__);
+               ret = -EINVAL;
+       }
+
+       return ret;
+}
+
+static const struct dev_pm_ops usi_v2_pm = {
+       .resume_noirq = usi_v2_resume_noirq,
+};
+
+static struct platform_driver usi_v2_driver = {
+       .driver = {
+               .name           = "usi_v2",
+               .owner          = THIS_MODULE,
+               .pm             = &usi_v2_pm,
+               .of_match_table = usi_v2_dt_match,
+       },
+       .probe                  = usi_v2_probe,
+};
+
+static int __init usi_v2_init(void)
+{
+       int ret = platform_driver_register(&usi_v2_driver);
+
+       if (ret)
+               pr_err("usi_v2 driver registrer failed\n");
+
+       return ret;
+}
+arch_initcall(usi_v2_init);
+
+static void __exit usi_v2_exit(void)
+{
+       platform_driver_unregister(&usi_v2_driver);
+}
+module_exit(usi_v2_exit);
+
+MODULE_AUTHOR("Youngmin Nam <youngmin.nam@samsung.com>");
+MODULE_DESCRIPTION("SAMSUNG USI v2 driver");
+MODULE_LICENSE("GPL");