Delta TN48M switches have a Lattice CPLD that serves
multiple purposes including being a GPIO expander.
So lets add the MFD core driver for it.
Signed-off-by: Robert Marko <robert.marko@xxxxxxxxxx>
---
drivers/mfd/Kconfig | 13 +++
drivers/mfd/Makefile | 1 +
drivers/mfd/tn48m-cpld.c | 181 ++++++++++++++++++++++++++++++++++++++
include/linux/mfd/tn48m.h | 30 +++++++
4 files changed, 225 insertions(+)
create mode 100644 drivers/mfd/tn48m-cpld.c
create mode 100644 include/linux/mfd/tn48m.h
diff --git a/drivers/mfd/Kconfig b/drivers/mfd/Kconfig
index b74efa469e90..809041f98d71 100644
--- a/drivers/mfd/Kconfig
+++ b/drivers/mfd/Kconfig
@@ -297,6 +297,19 @@ config MFD_ASIC3
This driver supports the ASIC3 multifunction chip found on many
PDAs (mainly iPAQ and HTC based ones)
+config MFD_TN48M_CPLD
+ tristate "Delta Networks TN48M switch CPLD driver"
+ depends on I2C
+ select MFD_CORE
+ select REGMAP_I2C
+ help
+ Select this option to enable support for Delta Networks TN48M switch
+ CPLD. It consists of GPIO and hwmon drivers.
+ CPLD provides GPIOS-s for the SFP slots as well as power supply
+ related information.
+ Driver provides debugfs information about the board model as
+ well as hardware and CPLD revision information.
+
config PMIC_DA903X
bool "Dialog Semiconductor DA9030/DA9034 PMIC Support"
depends on I2C=y
diff --git a/drivers/mfd/Makefile b/drivers/mfd/Makefile
index 834f5463af28..974663341f08 100644
--- a/drivers/mfd/Makefile
+++ b/drivers/mfd/Makefile
@@ -27,6 +27,7 @@ obj-$(CONFIG_MFD_TI_LP87565) += lp87565.o
obj-$(CONFIG_MFD_DAVINCI_VOICECODEC) += davinci_voicecodec.o
obj-$(CONFIG_MFD_DM355EVM_MSP) += dm355evm_msp.o
obj-$(CONFIG_MFD_TI_AM335X_TSCADC) += ti_am335x_tscadc.o
+obj-$(CONFIG_MFD_TN48M_CPLD) += tn48m-cpld.o
obj-$(CONFIG_MFD_STA2X11) += sta2x11-mfd.o
obj-$(CONFIG_MFD_STMPE) += stmpe.o
diff --git a/drivers/mfd/tn48m-cpld.c b/drivers/mfd/tn48m-cpld.c
new file mode 100644
index 000000000000..b84510fb630a
--- /dev/null
+++ b/drivers/mfd/tn48m-cpld.c
@@ -0,0 +1,181 @@
+// SPDX-License-Identifier: GPL-2.0-only
+/*
+ * Delta TN48M CPLD parent driver
+ *
+ * Copyright 2020 Sartura Ltd
+ *
+ * Author: Robert Marko <robert.marko@xxxxxxxxxx>
+ */
+
+#include <linux/debugfs.h>
+#include <linux/i2c.h>
+#include <linux/kernel.h>
+#include <linux/mfd/core.h>
+#include <linux/mfd/tn48m.h>
+#include <linux/module.h>
+#include <linux/platform_device.h>
+#include <linux/regmap.h>
+#include <linux/slab.h>
+
+static const struct mfd_cell tn48m_cell[] = {};
+
+static const struct regmap_config tn48m_regmap_config = {
+ .reg_bits = 8,
+ .val_bits = 8,
+ .max_register = 0x40,
+};
+
+static int hardware_version_show(struct seq_file *s, void *data)
+{
+ struct tn48m_data *priv = s->private;
+ unsigned int regval;
+ char *buf;
+
+ regmap_read(priv->regmap, HARDWARE_VERSION_ID, ®val);
+
+ switch (FIELD_GET(HARDWARE_VERSION_MASK, regval)) {
+ case HARDWARE_VERSION_EVT1:
+ buf = "EVT1";
+ break;
+ case HARDWARE_VERSION_EVT2:
+ buf = "EVT2";
+ break;
+ case HARDWARE_VERSION_DVT:
+ buf = "DVT";
+ break;
+ case HARDWARE_VERSION_PVT:
+ buf = "PVT";
+ break;
+ default:
+ buf = "Unknown";
+ break;
+ }
+
+ seq_printf(s, "%s\n", buf);
+
+ return 0;
+}
+
+DEFINE_SHOW_ATTRIBUTE(hardware_version);
+
+static int board_id_show(struct seq_file *s, void *data)
+{
+ struct tn48m_data *priv = s->private;
+ unsigned int regval;
+ char *buf;
+
+ regmap_read(priv->regmap, BOARD_ID, ®val);
+
+ switch (regval) {
+ case BOARD_ID_TN48M:
+ buf = "TN48M";
+ break;
+ case BOARD_ID_TN48M_P:
+ buf = "TN48-P";
+ break;
+ default:
+ buf = "Unknown";
+ break;
+ }
+
+ seq_printf(s, "%s\n", buf);
+
+ return 0;
+}
+
+DEFINE_SHOW_ATTRIBUTE(board_id);
+
+static int code_version_show(struct seq_file *s, void *data)
+{
+ struct tn48m_data *priv = s->private;
+ unsigned int regval;
+
+ regmap_read(priv->regmap, CPLD_CODE_VERSION, ®val);
+
+ seq_printf(s, "%d\n", regval);
+
+ return 0;
+}
+
+DEFINE_SHOW_ATTRIBUTE(code_version);
+
+static void tn48m_init_debugfs(struct tn48m_data *data)
+{
+ data->debugfs_dir = debugfs_create_dir(data->client->name, NULL);
+
+ debugfs_create_file("hardware_version",
+ 0400,
+ data->debugfs_dir,
+ data,
+ &hardware_version_fops);
+
+ debugfs_create_file("board_id",
+ 0400,
+ data->debugfs_dir,
+ data,
+ &board_id_fops);
+
+ debugfs_create_file("code_version",
+ 0400,
+ data->debugfs_dir,
+ data,
+ &code_version_fops);
+}
+
+static int tn48m_probe(struct i2c_client *client)
+{
+ struct tn48m_data *data;
+ int ret;
+
+ data = devm_kzalloc(&client->dev, sizeof(*data), GFP_KERNEL);
+ if (!data)
+ return -ENOMEM;
+
+ data->client = client;
+ data->dev = &client->dev;
+ i2c_set_clientdata(client, data);
+
+ data->regmap = devm_regmap_init_i2c(client, &tn48m_regmap_config);
+ if (IS_ERR(data->regmap)) {
+ dev_err(data->dev, "Failed to allocate regmap\n");
+ return PTR_ERR(data->regmap);
+ }
+
+ ret = devm_mfd_add_devices(data->dev, PLATFORM_DEVID_AUTO, tn48m_cell,
+ ARRAY_SIZE(tn48m_cell), NULL, 0, NULL);
+ if (ret)
+ dev_err(data->dev, "Failed to register sub-devices %d\n", ret);
+
+ tn48m_init_debugfs(data);
+
+ return ret;
+}
+
+static int tn48m_remove(struct i2c_client *client)
+{
+ struct tn48m_data *data = i2c_get_clientdata(client);
+
+ debugfs_remove_recursive(data->debugfs_dir);
+
+ return 0;
+}
+
+static const struct of_device_id tn48m_of_match[] = {
+ { .compatible = "delta,tn48m-cpld"},
+ { }
+};
+MODULE_DEVICE_TABLE(of, tn48m_of_match);
+
+static struct i2c_driver tn48m_driver = {
+ .driver = {
+ .name = "tn48m-cpld",
+ .of_match_table = tn48m_of_match,
+ },
+ .probe_new = tn48m_probe,
+ .remove = tn48m_remove,
+};
+module_i2c_driver(tn48m_driver);
+
+MODULE_AUTHOR("Robert Marko <robert.marko@xxxxxxxxxx>");
+MODULE_DESCRIPTION("Delta TN48M CPLD parent driver");
+MODULE_LICENSE("GPL");
diff --git a/include/linux/mfd/tn48m.h b/include/linux/mfd/tn48m.h
new file mode 100644
index 000000000000..551c550efa54
--- /dev/null
+++ b/include/linux/mfd/tn48m.h
@@ -0,0 +1,30 @@
+/* SPDX-License-Identifier: GPL-2.0-only */
+/*
+ * Copyright 2020 Sartura Ltd
+ */
+
+#ifndef __TN48M_H__
+#define __TN48M_H__
+
+#include <linux/device.h>
+#include <linux/regmap.h>
+
+#define HARDWARE_VERSION_ID 0x0
+#define HARDWARE_VERSION_MASK GENMASK(3, 0)
+#define HARDWARE_VERSION_EVT1 0
+#define HARDWARE_VERSION_EVT2 1
+#define HARDWARE_VERSION_DVT 2
+#define HARDWARE_VERSION_PVT 3
+#define BOARD_ID 0x1
+#define BOARD_ID_TN48M 0xa
+#define BOARD_ID_TN48M_P 0xb
+#define CPLD_CODE_VERSION 0x2
+
+struct tn48m_data {
+ struct device *dev;
+ struct regmap *regmap;
+ struct i2c_client *client;
+ struct dentry *debugfs_dir;
+};
+
+#endif
--
2.31.1
