Signed-off-by: Wei-Chun Pan <weichun....@advantech.com.tw>
---
drivers/mfd/Kconfig | 6 +
drivers/mfd/Makefile | 2 +
drivers/mfd/imanager2_core.c | 303 +++++++++++++++++++++++++++++++++++++++++++
3 files changed, 311 insertions(+)
create mode 100644 drivers/mfd/imanager2_core.c
diff --git a/drivers/mfd/Kconfig b/drivers/mfd/Kconfig
index 3383412..48b063f 100644
--- a/drivers/mfd/Kconfig
+++ b/drivers/mfd/Kconfig
@@ -10,6 +10,12 @@ config MFD_CORE
select IRQ_DOMAIN
default n
+config MFD_IMANAGER2
+ tristate "Support for Advantech iManager2 EC ICs"
+ select MFD_CORE
+ help
+ Support for Advantech iManager2 EC ICs
+
config MFD_CS5535
tristate "AMD CS5535 and CS5536 southbridge core functions"
select MFD_CORE
diff --git a/drivers/mfd/Makefile b/drivers/mfd/Makefile
index 2851275..10c64ae 100644
--- a/drivers/mfd/Makefile
+++ b/drivers/mfd/Makefile
@@ -166,3 +166,5 @@ obj-$(CONFIG_MFD_RETU) += retu-mfd.o
obj-$(CONFIG_MFD_AS3711) += as3711.o
obj-$(CONFIG_MFD_AS3722) += as3722.o
obj-$(CONFIG_MFD_STW481X) += stw481x.o
+imanager2-objs := imanager2_core.o imanager2_ec.o
+obj-$(CONFIG_MFD_IMANAGER2) += imanager2.o
diff --git a/drivers/mfd/imanager2_core.c b/drivers/mfd/imanager2_core.c
new file mode 100644
index 0000000..2264d29
--- /dev/null
+++ b/drivers/mfd/imanager2_core.c
@@ -0,0 +1,303 @@
+/*
+ * imanager2_core.c - MFD core driver of Advantech EC IT8516/18/28
+ * Copyright (C) 2014 Richard Vidal-Dorsch <richard.dor...@advantech.com>
+ *
+ * This program is free software: you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation, either version 3 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program. If not, see <http://www.gnu.org/licenses/>.
+ */
+
+#include <linux/module.h>
+#include <linux/mfd/core.h>
+#include <linux/mfd/imanager2_ec.h>
+
+#define DRV_NAME "imanager2"
+#define DRV_VERSION "4.0.1"
+
+static struct mfd_cell imanager2_cells[] = {
+ {
+ .name = "imanager2_hwm",
+ },
+ {
+ .name = "imanager2_i2c",
+ },
+};
+
+enum chips {
+ it8516 = 0x8516,
+ it8518 = 0x8518,
+ it8528 = 0x8528,
+};
+
+#define EC_CMD_AUTHENTICATION 0x30
+
+static int imanager2_authentication(struct imanager2 *ec)
+{
+ u8 tmp;
+ int ret;
+
+ mutex_lock(&ec->lock);
+
+ if (inb(EC_IO_PORT_CMD) == 0xFF && inb(EC_IO_PORT_DATA) == 0xFF) {
+ ret = -ENODEV;
+ goto unlock;
+ }
+
+ if (inb(EC_IO_PORT_CMD) & IO_FLAG_OBF)
+ inb(EC_IO_PORT_DATA); /* initial OBF */
+
+ if (ec_outb_after_ibc0(EC_IO_PORT_CMD, EC_CMD_AUTHENTICATION)) {
+ ret = -ENODEV;
+ goto unlock;
+ }
+
+ ret = ec_inb_after_obf1(&tmp);
+
+unlock:
+ mutex_unlock(&ec->lock);
+
+ if (ret)
+ return ret;
+
+ if (tmp != 0x95)
+ return -ENODEV;
+
+ return 0;
+}
+
+#define EC_ITE_CHIPID_H8 0x20
+#define EC_ITE_CHIPID_L8 0x21
+
+static int imanager2_get_chip_type(struct imanager2 *ec)
+{
+ mutex_lock(&ec->lock);
+
+ outb(EC_ITE_CHIPID_H8, EC_SIO_CMD);
+ ec->id = inb(EC_SIO_DATA) << 8;
+ outb(EC_ITE_CHIPID_L8, EC_SIO_CMD);
+ ec->id |= inb(EC_SIO_DATA);
+
+ mutex_unlock(&ec->lock);
+
+ switch (ec->id) {
+ case it8516:
+ case it8518:
+ ec->flag = EC_FLAG_IO;
+ break;
+ case it8528:
+ ec->flag |= EC_FLAG_IO_MAILBOX;
+ break;
+ default:
+ return -ENODEV;
+ }
+
+ return 0;
+}
+
+/*
+ * EC provides IO channel and ITE mailbox ways to access mailbox. IO channel is
+ * a common way to access mailbox, but IET mailbox way is much faster than IO
+ * channel. We prefer ITE mailbox if firmware supports. Source kernel code
+ * X11_05 the first firmware version that supports ITE mailbox.
+ */
+#define EC_CHIPFW_SUPP_ITEMAILBOX 0x1105
+
+static int imanager2_get_info(struct imanager2 *ec)
+{
+ int ret;
+ u8 *tmp = (u8 *)&ec->version.kernel_ver;
+
+ mutex_lock(&ec->lock);
+
+ ret = imanager2_mbox_io_read(EC_CMD_ACPIRAM_READ,
+ EC_ACPIRAM_ADDR_KERNEL_MAJOR_VERSION,
+ &tmp[0], 2);
+
+ if (ret)
+ goto unlock;
+
+ if (ec->version.kernel_ver >= EC_CHIPFW_SUPP_ITEMAILBOX) {
+ ec->flag |= EC_FLAG_MAILBOX;
+ ret = imanager2_mbox_get_project_information(
+ ec->flag, ec->prj_name,
+ &ec->version.kernel_ver, &ec->version.chip_code,
+ &ec->version.prj_id, &ec->version.prj_ver);
+ } else {
+ ec->flag &= ~EC_FLAG_MAILBOX;
+ ret = imanager2_mbox_io_read(
+ EC_CMD_ACPIRAM_READ,
+ EC_ACPIRAM_ADDR_KERNEL_MAJOR_VERSION,
+ &tmp[0], sizeof(struct ec_version));
+ }
+unlock:
+ mutex_unlock(&ec->lock);
+
+ return ret;
+}
+
+static int imanager2_device_initial_by_ite(struct imanager2 *ec)
+{
+ int i, ret;
+
+ mutex_lock(&ec->lock);
+
+ ret = imanager2_mbox_get_dynamic_table(ec->flag, EC_DYNAMIC_DEVICE_ID,
+ ec->table.devid);
+ if (ret)
+ goto unlock;
+
+ ret = imanager2_mbox_get_dynamic_table(ec->flag, EC_DYNAMIC_HW_PIN,
+ ec->table.pinnum);
+unlock:
+ mutex_unlock(&ec->lock);
+
+ if (ret)
+ return ret;
+
+ for (i = 0; i < EC_MAX_ITEM_NUM; i++) {
+ if (ec->table.devid[i] == EC_TABLE_DID_NODEV)
+ break;
+
+ ec->table.devid2itemnum[ec->table.devid[i]] = i;
+ }
+
+ return 0;
+}
+
+static int imanager2_device_initial_by_io(struct imanager2 *ec)
+{
+ int i, ret;
+ u8 tmp;
+
+ mutex_lock(&ec->lock);
+
+ for (i = 0; i < EC_MAX_ITEM_NUM; i++) {
+ ret = imanager2_mbox_io_read
+ (EC_CMD_HWCTRLTABLE_INDEX, i, &tmp, 1);
+ if (ret)
+ break;
+ if (tmp == EC_TABLE_NOITEM)
+ break;
+
+ ret = imanager2_mbox_io_simple_read(
+ EC_CMD_HWCTRLTABLE_GET_PIN_NUM, &ec->table.pinnum[i]);
+ if (ret)
+ break;
+
+ ret = imanager2_mbox_io_simple_read(
+ EC_CMD_HWCTRLTABLE_GET_DEVICE_ID, &ec->table.devid[i]);
+ if (ret)
+ break;
+
+ if (ec->table.devid[i] == EC_TABLE_DID_NODEV)
+ continue;
+
+ ec->table.devid2itemnum[ec->table.devid[i]] = i;
+ }
+
+ mutex_unlock(&ec->lock);
+
+ if (ret)
+ return ret;
+
+ if (i < EC_MAX_ITEM_NUM) {
+ memset(&ec->table.devid[i], EC_TABLE_DID_NODEV,
+ EC_MAX_ITEM_NUM - i);
+ memset(&ec->table.pinnum[i], EC_TABLE_HWP_NODEV,
+ EC_MAX_ITEM_NUM - i);
+ }
+
+ return ret;
+}
+
+static int imanager2_build_device_table(struct imanager2 *ec)
+{
+ memset(&ec->table.devid2itemnum[0], EC_TABLE_ITEM_UNUSED,
+ ARRAY_SIZE(ec->table.devid2itemnum));
+
+ if (ec->flag & EC_FLAG_MAILBOX)
+ return imanager2_device_initial_by_ite(ec);
+ else
+ return imanager2_device_initial_by_io(ec);
+}
+
+static struct platform_device *ec_pdev;
+
+static int __init imanager2_mfd_device_init(void)
+{
+ struct imanager2 ec = { 0 };
+ int ret;
+
+ mutex_init(&ec.lock);
+
+ ret = imanager2_authentication(&ec);
+ if (ret)
+ return ret;
+
+ ret = imanager2_get_chip_type(&ec);
+ if (ret)
+ return ret;
+
+ ret = imanager2_get_info(&ec);
+ if (ret)
+ return ret;
+
+ ret = imanager2_build_device_table(&ec);
+ if (ret)
+ return ret;
+
+ ec_pdev = platform_device_alloc(DRV_NAME, PLATFORM_DEVID_AUTO);
+ if (!ec_pdev)
+ return -ENOMEM;
+
+ if (!devm_request_region(&ec_pdev->dev, EC_IO_PORT_DATA, 2, DRV_NAME))
+ return -EIO;
+
+ if (!devm_request_region(&ec_pdev->dev, EC_ITE_PORT_OFS, 2, DRV_NAME))
+ return -EIO;
+
+ ret = platform_device_add_data(ec_pdev, &ec, sizeof(struct imanager2));
+ if (ret)
+ goto exit_device_put;
+
+ ret = platform_device_add(ec_pdev);
+ if (ret)
+ goto exit_device_put;
+
+ ret = mfd_add_devices(&ec_pdev->dev, -1, imanager2_cells,
+ ARRAY_SIZE(imanager2_cells), NULL, -1, NULL);
+ if (ret)
+ goto exit_device_unregister;
+
+ return 0;
+
+exit_device_unregister:
+ platform_device_unregister(ec_pdev);
+exit_device_put:
+ platform_device_put(ec_pdev);
+
+ return ret;
+}
+
+static void __exit imanager2_mfd_device_exit(void)
+{
+ mfd_remove_devices(&ec_pdev->dev);
+ platform_device_unregister(ec_pdev);
+}
+
+module_init(imanager2_mfd_device_init);
+module_exit(imanager2_mfd_device_exit);
+
+MODULE_AUTHOR("Richard Vidal-Dorsch <richard.dorsch at advantech.com>");
+MODULE_DESCRIPTION("iManager2 platform device definitions v" DRV_VERSION);
+MODULE_LICENSE("GPL");
+MODULE_VERSION(DRV_VERSION);
--
1.9.1
--
To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
the body of a message to majord...@vger.kernel.org
More majordomo info at http://vger.kernel.org/majordomo-info.html
Please read the FAQ at http://www.tux.org/lkml/
