18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * Turris Mox module configuration bus driver
48c2ecf20Sopenharmony_ci *
58c2ecf20Sopenharmony_ci * Copyright (C) 2019 Marek Behun <marek.behun@nic.cz>
68c2ecf20Sopenharmony_ci */
78c2ecf20Sopenharmony_ci
88c2ecf20Sopenharmony_ci#include <dt-bindings/bus/moxtet.h>
98c2ecf20Sopenharmony_ci#include <linux/bitops.h>
108c2ecf20Sopenharmony_ci#include <linux/debugfs.h>
118c2ecf20Sopenharmony_ci#include <linux/interrupt.h>
128c2ecf20Sopenharmony_ci#include <linux/module.h>
138c2ecf20Sopenharmony_ci#include <linux/moxtet.h>
148c2ecf20Sopenharmony_ci#include <linux/mutex.h>
158c2ecf20Sopenharmony_ci#include <linux/of_device.h>
168c2ecf20Sopenharmony_ci#include <linux/of_irq.h>
178c2ecf20Sopenharmony_ci#include <linux/spi/spi.h>
188c2ecf20Sopenharmony_ci
198c2ecf20Sopenharmony_ci/*
208c2ecf20Sopenharmony_ci * @name:	module name for sysfs
218c2ecf20Sopenharmony_ci * @hwirq_base:	base index for IRQ for this module (-1 if no IRQs)
228c2ecf20Sopenharmony_ci * @nirqs:	how many interrupts does the shift register provide
238c2ecf20Sopenharmony_ci * @desc:	module description for kernel log
248c2ecf20Sopenharmony_ci */
258c2ecf20Sopenharmony_cistatic const struct {
268c2ecf20Sopenharmony_ci	const char *name;
278c2ecf20Sopenharmony_ci	int hwirq_base;
288c2ecf20Sopenharmony_ci	int nirqs;
298c2ecf20Sopenharmony_ci	const char *desc;
308c2ecf20Sopenharmony_ci} mox_module_table[] = {
318c2ecf20Sopenharmony_ci	/* do not change order of this array! */
328c2ecf20Sopenharmony_ci	{ NULL,		 0,			0, NULL },
338c2ecf20Sopenharmony_ci	{ "sfp",	-1,			0, "MOX D (SFP cage)" },
348c2ecf20Sopenharmony_ci	{ "pci",	MOXTET_IRQ_PCI,		1, "MOX B (Mini-PCIe)" },
358c2ecf20Sopenharmony_ci	{ "topaz",	MOXTET_IRQ_TOPAZ,	1, "MOX C (4 port switch)" },
368c2ecf20Sopenharmony_ci	{ "peridot",	MOXTET_IRQ_PERIDOT(0),	1, "MOX E (8 port switch)" },
378c2ecf20Sopenharmony_ci	{ "usb3",	MOXTET_IRQ_USB3,	2, "MOX F (USB 3.0)" },
388c2ecf20Sopenharmony_ci	{ "pci-bridge",	-1,			0, "MOX G (Mini-PCIe bridge)" },
398c2ecf20Sopenharmony_ci};
408c2ecf20Sopenharmony_ci
418c2ecf20Sopenharmony_cistatic inline bool mox_module_known(unsigned int id)
428c2ecf20Sopenharmony_ci{
438c2ecf20Sopenharmony_ci	return id >= TURRIS_MOX_MODULE_FIRST && id <= TURRIS_MOX_MODULE_LAST;
448c2ecf20Sopenharmony_ci}
458c2ecf20Sopenharmony_ci
468c2ecf20Sopenharmony_cistatic inline const char *mox_module_name(unsigned int id)
478c2ecf20Sopenharmony_ci{
488c2ecf20Sopenharmony_ci	if (mox_module_known(id))
498c2ecf20Sopenharmony_ci		return mox_module_table[id].name;
508c2ecf20Sopenharmony_ci	else
518c2ecf20Sopenharmony_ci		return "unknown";
528c2ecf20Sopenharmony_ci}
538c2ecf20Sopenharmony_ci
548c2ecf20Sopenharmony_ci#define DEF_MODULE_ATTR(name, fmt, ...)					\
558c2ecf20Sopenharmony_cistatic ssize_t								\
568c2ecf20Sopenharmony_cimodule_##name##_show(struct device *dev, struct device_attribute *a,	\
578c2ecf20Sopenharmony_ci		     char *buf)						\
588c2ecf20Sopenharmony_ci{									\
598c2ecf20Sopenharmony_ci	struct moxtet_device *mdev = to_moxtet_device(dev);		\
608c2ecf20Sopenharmony_ci	return sprintf(buf, (fmt), __VA_ARGS__);			\
618c2ecf20Sopenharmony_ci}									\
628c2ecf20Sopenharmony_cistatic DEVICE_ATTR_RO(module_##name)
638c2ecf20Sopenharmony_ci
648c2ecf20Sopenharmony_ciDEF_MODULE_ATTR(id, "0x%x\n", mdev->id);
658c2ecf20Sopenharmony_ciDEF_MODULE_ATTR(name, "%s\n", mox_module_name(mdev->id));
668c2ecf20Sopenharmony_ciDEF_MODULE_ATTR(description, "%s\n",
678c2ecf20Sopenharmony_ci		mox_module_known(mdev->id) ? mox_module_table[mdev->id].desc
688c2ecf20Sopenharmony_ci					   : "");
698c2ecf20Sopenharmony_ci
708c2ecf20Sopenharmony_cistatic struct attribute *moxtet_dev_attrs[] = {
718c2ecf20Sopenharmony_ci	&dev_attr_module_id.attr,
728c2ecf20Sopenharmony_ci	&dev_attr_module_name.attr,
738c2ecf20Sopenharmony_ci	&dev_attr_module_description.attr,
748c2ecf20Sopenharmony_ci	NULL,
758c2ecf20Sopenharmony_ci};
768c2ecf20Sopenharmony_ci
778c2ecf20Sopenharmony_cistatic const struct attribute_group moxtet_dev_group = {
788c2ecf20Sopenharmony_ci	.attrs = moxtet_dev_attrs,
798c2ecf20Sopenharmony_ci};
808c2ecf20Sopenharmony_ci
818c2ecf20Sopenharmony_cistatic const struct attribute_group *moxtet_dev_groups[] = {
828c2ecf20Sopenharmony_ci	&moxtet_dev_group,
838c2ecf20Sopenharmony_ci	NULL,
848c2ecf20Sopenharmony_ci};
858c2ecf20Sopenharmony_ci
868c2ecf20Sopenharmony_cistatic int moxtet_match(struct device *dev, struct device_driver *drv)
878c2ecf20Sopenharmony_ci{
888c2ecf20Sopenharmony_ci	struct moxtet_device *mdev = to_moxtet_device(dev);
898c2ecf20Sopenharmony_ci	struct moxtet_driver *tdrv = to_moxtet_driver(drv);
908c2ecf20Sopenharmony_ci	const enum turris_mox_module_id *t;
918c2ecf20Sopenharmony_ci
928c2ecf20Sopenharmony_ci	if (of_driver_match_device(dev, drv))
938c2ecf20Sopenharmony_ci		return 1;
948c2ecf20Sopenharmony_ci
958c2ecf20Sopenharmony_ci	if (!tdrv->id_table)
968c2ecf20Sopenharmony_ci		return 0;
978c2ecf20Sopenharmony_ci
988c2ecf20Sopenharmony_ci	for (t = tdrv->id_table; *t; ++t)
998c2ecf20Sopenharmony_ci		if (*t == mdev->id)
1008c2ecf20Sopenharmony_ci			return 1;
1018c2ecf20Sopenharmony_ci
1028c2ecf20Sopenharmony_ci	return 0;
1038c2ecf20Sopenharmony_ci}
1048c2ecf20Sopenharmony_ci
1058c2ecf20Sopenharmony_cistatic struct bus_type moxtet_bus_type = {
1068c2ecf20Sopenharmony_ci	.name		= "moxtet",
1078c2ecf20Sopenharmony_ci	.dev_groups	= moxtet_dev_groups,
1088c2ecf20Sopenharmony_ci	.match		= moxtet_match,
1098c2ecf20Sopenharmony_ci};
1108c2ecf20Sopenharmony_ci
1118c2ecf20Sopenharmony_ciint __moxtet_register_driver(struct module *owner,
1128c2ecf20Sopenharmony_ci			     struct moxtet_driver *mdrv)
1138c2ecf20Sopenharmony_ci{
1148c2ecf20Sopenharmony_ci	mdrv->driver.owner = owner;
1158c2ecf20Sopenharmony_ci	mdrv->driver.bus = &moxtet_bus_type;
1168c2ecf20Sopenharmony_ci	return driver_register(&mdrv->driver);
1178c2ecf20Sopenharmony_ci}
1188c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(__moxtet_register_driver);
1198c2ecf20Sopenharmony_ci
1208c2ecf20Sopenharmony_cistatic int moxtet_dev_check(struct device *dev, void *data)
1218c2ecf20Sopenharmony_ci{
1228c2ecf20Sopenharmony_ci	struct moxtet_device *mdev = to_moxtet_device(dev);
1238c2ecf20Sopenharmony_ci	struct moxtet_device *new_dev = data;
1248c2ecf20Sopenharmony_ci
1258c2ecf20Sopenharmony_ci	if (mdev->moxtet == new_dev->moxtet && mdev->id == new_dev->id &&
1268c2ecf20Sopenharmony_ci	    mdev->idx == new_dev->idx)
1278c2ecf20Sopenharmony_ci		return -EBUSY;
1288c2ecf20Sopenharmony_ci	return 0;
1298c2ecf20Sopenharmony_ci}
1308c2ecf20Sopenharmony_ci
1318c2ecf20Sopenharmony_cistatic void moxtet_dev_release(struct device *dev)
1328c2ecf20Sopenharmony_ci{
1338c2ecf20Sopenharmony_ci	struct moxtet_device *mdev = to_moxtet_device(dev);
1348c2ecf20Sopenharmony_ci
1358c2ecf20Sopenharmony_ci	put_device(mdev->moxtet->dev);
1368c2ecf20Sopenharmony_ci	kfree(mdev);
1378c2ecf20Sopenharmony_ci}
1388c2ecf20Sopenharmony_ci
1398c2ecf20Sopenharmony_cistatic struct moxtet_device *
1408c2ecf20Sopenharmony_cimoxtet_alloc_device(struct moxtet *moxtet)
1418c2ecf20Sopenharmony_ci{
1428c2ecf20Sopenharmony_ci	struct moxtet_device *dev;
1438c2ecf20Sopenharmony_ci
1448c2ecf20Sopenharmony_ci	if (!get_device(moxtet->dev))
1458c2ecf20Sopenharmony_ci		return NULL;
1468c2ecf20Sopenharmony_ci
1478c2ecf20Sopenharmony_ci	dev = kzalloc(sizeof(*dev), GFP_KERNEL);
1488c2ecf20Sopenharmony_ci	if (!dev) {
1498c2ecf20Sopenharmony_ci		put_device(moxtet->dev);
1508c2ecf20Sopenharmony_ci		return NULL;
1518c2ecf20Sopenharmony_ci	}
1528c2ecf20Sopenharmony_ci
1538c2ecf20Sopenharmony_ci	dev->moxtet = moxtet;
1548c2ecf20Sopenharmony_ci	dev->dev.parent = moxtet->dev;
1558c2ecf20Sopenharmony_ci	dev->dev.bus = &moxtet_bus_type;
1568c2ecf20Sopenharmony_ci	dev->dev.release = moxtet_dev_release;
1578c2ecf20Sopenharmony_ci
1588c2ecf20Sopenharmony_ci	device_initialize(&dev->dev);
1598c2ecf20Sopenharmony_ci
1608c2ecf20Sopenharmony_ci	return dev;
1618c2ecf20Sopenharmony_ci}
1628c2ecf20Sopenharmony_ci
1638c2ecf20Sopenharmony_cistatic int moxtet_add_device(struct moxtet_device *dev)
1648c2ecf20Sopenharmony_ci{
1658c2ecf20Sopenharmony_ci	static DEFINE_MUTEX(add_mutex);
1668c2ecf20Sopenharmony_ci	int ret;
1678c2ecf20Sopenharmony_ci
1688c2ecf20Sopenharmony_ci	if (dev->idx >= TURRIS_MOX_MAX_MODULES || dev->id > 0xf)
1698c2ecf20Sopenharmony_ci		return -EINVAL;
1708c2ecf20Sopenharmony_ci
1718c2ecf20Sopenharmony_ci	dev_set_name(&dev->dev, "moxtet-%s.%u", mox_module_name(dev->id),
1728c2ecf20Sopenharmony_ci		     dev->idx);
1738c2ecf20Sopenharmony_ci
1748c2ecf20Sopenharmony_ci	mutex_lock(&add_mutex);
1758c2ecf20Sopenharmony_ci
1768c2ecf20Sopenharmony_ci	ret = bus_for_each_dev(&moxtet_bus_type, NULL, dev,
1778c2ecf20Sopenharmony_ci			       moxtet_dev_check);
1788c2ecf20Sopenharmony_ci	if (ret)
1798c2ecf20Sopenharmony_ci		goto done;
1808c2ecf20Sopenharmony_ci
1818c2ecf20Sopenharmony_ci	ret = device_add(&dev->dev);
1828c2ecf20Sopenharmony_ci	if (ret < 0)
1838c2ecf20Sopenharmony_ci		dev_err(dev->moxtet->dev, "can't add %s, status %d\n",
1848c2ecf20Sopenharmony_ci			dev_name(dev->moxtet->dev), ret);
1858c2ecf20Sopenharmony_ci
1868c2ecf20Sopenharmony_cidone:
1878c2ecf20Sopenharmony_ci	mutex_unlock(&add_mutex);
1888c2ecf20Sopenharmony_ci	return ret;
1898c2ecf20Sopenharmony_ci}
1908c2ecf20Sopenharmony_ci
1918c2ecf20Sopenharmony_cistatic int __unregister(struct device *dev, void *null)
1928c2ecf20Sopenharmony_ci{
1938c2ecf20Sopenharmony_ci	if (dev->of_node) {
1948c2ecf20Sopenharmony_ci		of_node_clear_flag(dev->of_node, OF_POPULATED);
1958c2ecf20Sopenharmony_ci		of_node_put(dev->of_node);
1968c2ecf20Sopenharmony_ci	}
1978c2ecf20Sopenharmony_ci
1988c2ecf20Sopenharmony_ci	device_unregister(dev);
1998c2ecf20Sopenharmony_ci
2008c2ecf20Sopenharmony_ci	return 0;
2018c2ecf20Sopenharmony_ci}
2028c2ecf20Sopenharmony_ci
2038c2ecf20Sopenharmony_cistatic struct moxtet_device *
2048c2ecf20Sopenharmony_ciof_register_moxtet_device(struct moxtet *moxtet, struct device_node *nc)
2058c2ecf20Sopenharmony_ci{
2068c2ecf20Sopenharmony_ci	struct moxtet_device *dev;
2078c2ecf20Sopenharmony_ci	u32 val;
2088c2ecf20Sopenharmony_ci	int ret;
2098c2ecf20Sopenharmony_ci
2108c2ecf20Sopenharmony_ci	dev = moxtet_alloc_device(moxtet);
2118c2ecf20Sopenharmony_ci	if (!dev) {
2128c2ecf20Sopenharmony_ci		dev_err(moxtet->dev,
2138c2ecf20Sopenharmony_ci			"Moxtet device alloc error for %pOF\n", nc);
2148c2ecf20Sopenharmony_ci		return ERR_PTR(-ENOMEM);
2158c2ecf20Sopenharmony_ci	}
2168c2ecf20Sopenharmony_ci
2178c2ecf20Sopenharmony_ci	ret = of_property_read_u32(nc, "reg", &val);
2188c2ecf20Sopenharmony_ci	if (ret) {
2198c2ecf20Sopenharmony_ci		dev_err(moxtet->dev, "%pOF has no valid 'reg' property (%d)\n",
2208c2ecf20Sopenharmony_ci			nc, ret);
2218c2ecf20Sopenharmony_ci		goto err_put;
2228c2ecf20Sopenharmony_ci	}
2238c2ecf20Sopenharmony_ci
2248c2ecf20Sopenharmony_ci	dev->idx = val;
2258c2ecf20Sopenharmony_ci
2268c2ecf20Sopenharmony_ci	if (dev->idx >= TURRIS_MOX_MAX_MODULES) {
2278c2ecf20Sopenharmony_ci		dev_err(moxtet->dev, "%pOF Moxtet address 0x%x out of range\n",
2288c2ecf20Sopenharmony_ci			nc, dev->idx);
2298c2ecf20Sopenharmony_ci		ret = -EINVAL;
2308c2ecf20Sopenharmony_ci		goto err_put;
2318c2ecf20Sopenharmony_ci	}
2328c2ecf20Sopenharmony_ci
2338c2ecf20Sopenharmony_ci	dev->id = moxtet->modules[dev->idx];
2348c2ecf20Sopenharmony_ci
2358c2ecf20Sopenharmony_ci	if (!dev->id) {
2368c2ecf20Sopenharmony_ci		dev_err(moxtet->dev, "%pOF Moxtet address 0x%x is empty\n", nc,
2378c2ecf20Sopenharmony_ci			dev->idx);
2388c2ecf20Sopenharmony_ci		ret = -ENODEV;
2398c2ecf20Sopenharmony_ci		goto err_put;
2408c2ecf20Sopenharmony_ci	}
2418c2ecf20Sopenharmony_ci
2428c2ecf20Sopenharmony_ci	of_node_get(nc);
2438c2ecf20Sopenharmony_ci	dev->dev.of_node = nc;
2448c2ecf20Sopenharmony_ci
2458c2ecf20Sopenharmony_ci	ret = moxtet_add_device(dev);
2468c2ecf20Sopenharmony_ci	if (ret) {
2478c2ecf20Sopenharmony_ci		dev_err(moxtet->dev,
2488c2ecf20Sopenharmony_ci			"Moxtet device register error for %pOF\n", nc);
2498c2ecf20Sopenharmony_ci		of_node_put(nc);
2508c2ecf20Sopenharmony_ci		goto err_put;
2518c2ecf20Sopenharmony_ci	}
2528c2ecf20Sopenharmony_ci
2538c2ecf20Sopenharmony_ci	return dev;
2548c2ecf20Sopenharmony_ci
2558c2ecf20Sopenharmony_cierr_put:
2568c2ecf20Sopenharmony_ci	put_device(&dev->dev);
2578c2ecf20Sopenharmony_ci	return ERR_PTR(ret);
2588c2ecf20Sopenharmony_ci}
2598c2ecf20Sopenharmony_ci
2608c2ecf20Sopenharmony_cistatic void of_register_moxtet_devices(struct moxtet *moxtet)
2618c2ecf20Sopenharmony_ci{
2628c2ecf20Sopenharmony_ci	struct moxtet_device *dev;
2638c2ecf20Sopenharmony_ci	struct device_node *nc;
2648c2ecf20Sopenharmony_ci
2658c2ecf20Sopenharmony_ci	if (!moxtet->dev->of_node)
2668c2ecf20Sopenharmony_ci		return;
2678c2ecf20Sopenharmony_ci
2688c2ecf20Sopenharmony_ci	for_each_available_child_of_node(moxtet->dev->of_node, nc) {
2698c2ecf20Sopenharmony_ci		if (of_node_test_and_set_flag(nc, OF_POPULATED))
2708c2ecf20Sopenharmony_ci			continue;
2718c2ecf20Sopenharmony_ci		dev = of_register_moxtet_device(moxtet, nc);
2728c2ecf20Sopenharmony_ci		if (IS_ERR(dev)) {
2738c2ecf20Sopenharmony_ci			dev_warn(moxtet->dev,
2748c2ecf20Sopenharmony_ci				 "Failed to create Moxtet device for %pOF\n",
2758c2ecf20Sopenharmony_ci				 nc);
2768c2ecf20Sopenharmony_ci			of_node_clear_flag(nc, OF_POPULATED);
2778c2ecf20Sopenharmony_ci		}
2788c2ecf20Sopenharmony_ci	}
2798c2ecf20Sopenharmony_ci}
2808c2ecf20Sopenharmony_ci
2818c2ecf20Sopenharmony_cistatic void
2828c2ecf20Sopenharmony_cimoxtet_register_devices_from_topology(struct moxtet *moxtet)
2838c2ecf20Sopenharmony_ci{
2848c2ecf20Sopenharmony_ci	struct moxtet_device *dev;
2858c2ecf20Sopenharmony_ci	int i, ret;
2868c2ecf20Sopenharmony_ci
2878c2ecf20Sopenharmony_ci	for (i = 0; i < moxtet->count; ++i) {
2888c2ecf20Sopenharmony_ci		dev = moxtet_alloc_device(moxtet);
2898c2ecf20Sopenharmony_ci		if (!dev) {
2908c2ecf20Sopenharmony_ci			dev_err(moxtet->dev, "Moxtet device %u alloc error\n",
2918c2ecf20Sopenharmony_ci				i);
2928c2ecf20Sopenharmony_ci			continue;
2938c2ecf20Sopenharmony_ci		}
2948c2ecf20Sopenharmony_ci
2958c2ecf20Sopenharmony_ci		dev->idx = i;
2968c2ecf20Sopenharmony_ci		dev->id = moxtet->modules[i];
2978c2ecf20Sopenharmony_ci
2988c2ecf20Sopenharmony_ci		ret = moxtet_add_device(dev);
2998c2ecf20Sopenharmony_ci		if (ret && ret != -EBUSY) {
3008c2ecf20Sopenharmony_ci			put_device(&dev->dev);
3018c2ecf20Sopenharmony_ci			dev_err(moxtet->dev,
3028c2ecf20Sopenharmony_ci				"Moxtet device %u register error: %i\n", i,
3038c2ecf20Sopenharmony_ci				ret);
3048c2ecf20Sopenharmony_ci		}
3058c2ecf20Sopenharmony_ci	}
3068c2ecf20Sopenharmony_ci}
3078c2ecf20Sopenharmony_ci
3088c2ecf20Sopenharmony_ci/*
3098c2ecf20Sopenharmony_ci * @nsame:	how many modules with same id are already in moxtet->modules
3108c2ecf20Sopenharmony_ci */
3118c2ecf20Sopenharmony_cistatic int moxtet_set_irq(struct moxtet *moxtet, int idx, int id, int nsame)
3128c2ecf20Sopenharmony_ci{
3138c2ecf20Sopenharmony_ci	int i, first;
3148c2ecf20Sopenharmony_ci	struct moxtet_irqpos *pos;
3158c2ecf20Sopenharmony_ci
3168c2ecf20Sopenharmony_ci	first = mox_module_table[id].hwirq_base +
3178c2ecf20Sopenharmony_ci		nsame * mox_module_table[id].nirqs;
3188c2ecf20Sopenharmony_ci
3198c2ecf20Sopenharmony_ci	if (first + mox_module_table[id].nirqs > MOXTET_NIRQS)
3208c2ecf20Sopenharmony_ci		return -EINVAL;
3218c2ecf20Sopenharmony_ci
3228c2ecf20Sopenharmony_ci	for (i = 0; i < mox_module_table[id].nirqs; ++i) {
3238c2ecf20Sopenharmony_ci		pos = &moxtet->irq.position[first + i];
3248c2ecf20Sopenharmony_ci		pos->idx = idx;
3258c2ecf20Sopenharmony_ci		pos->bit = i;
3268c2ecf20Sopenharmony_ci		moxtet->irq.exists |= BIT(first + i);
3278c2ecf20Sopenharmony_ci	}
3288c2ecf20Sopenharmony_ci
3298c2ecf20Sopenharmony_ci	return 0;
3308c2ecf20Sopenharmony_ci}
3318c2ecf20Sopenharmony_ci
3328c2ecf20Sopenharmony_cistatic int moxtet_find_topology(struct moxtet *moxtet)
3338c2ecf20Sopenharmony_ci{
3348c2ecf20Sopenharmony_ci	u8 buf[TURRIS_MOX_MAX_MODULES];
3358c2ecf20Sopenharmony_ci	int cnts[TURRIS_MOX_MODULE_LAST];
3368c2ecf20Sopenharmony_ci	int i, ret;
3378c2ecf20Sopenharmony_ci
3388c2ecf20Sopenharmony_ci	memset(cnts, 0, sizeof(cnts));
3398c2ecf20Sopenharmony_ci
3408c2ecf20Sopenharmony_ci	ret = spi_read(to_spi_device(moxtet->dev), buf, TURRIS_MOX_MAX_MODULES);
3418c2ecf20Sopenharmony_ci	if (ret < 0)
3428c2ecf20Sopenharmony_ci		return ret;
3438c2ecf20Sopenharmony_ci
3448c2ecf20Sopenharmony_ci	if (buf[0] == TURRIS_MOX_CPU_ID_EMMC) {
3458c2ecf20Sopenharmony_ci		dev_info(moxtet->dev, "Found MOX A (eMMC CPU) module\n");
3468c2ecf20Sopenharmony_ci	} else if (buf[0] == TURRIS_MOX_CPU_ID_SD) {
3478c2ecf20Sopenharmony_ci		dev_info(moxtet->dev, "Found MOX A (CPU) module\n");
3488c2ecf20Sopenharmony_ci	} else {
3498c2ecf20Sopenharmony_ci		dev_err(moxtet->dev, "Invalid Turris MOX A CPU module 0x%02x\n",
3508c2ecf20Sopenharmony_ci			buf[0]);
3518c2ecf20Sopenharmony_ci		return -ENODEV;
3528c2ecf20Sopenharmony_ci	}
3538c2ecf20Sopenharmony_ci
3548c2ecf20Sopenharmony_ci	moxtet->count = 0;
3558c2ecf20Sopenharmony_ci
3568c2ecf20Sopenharmony_ci	for (i = 1; i < TURRIS_MOX_MAX_MODULES; ++i) {
3578c2ecf20Sopenharmony_ci		int id;
3588c2ecf20Sopenharmony_ci
3598c2ecf20Sopenharmony_ci		if (buf[i] == 0xff)
3608c2ecf20Sopenharmony_ci			break;
3618c2ecf20Sopenharmony_ci
3628c2ecf20Sopenharmony_ci		id = buf[i] & 0xf;
3638c2ecf20Sopenharmony_ci
3648c2ecf20Sopenharmony_ci		moxtet->modules[i-1] = id;
3658c2ecf20Sopenharmony_ci		++moxtet->count;
3668c2ecf20Sopenharmony_ci
3678c2ecf20Sopenharmony_ci		if (mox_module_known(id)) {
3688c2ecf20Sopenharmony_ci			dev_info(moxtet->dev, "Found %s module\n",
3698c2ecf20Sopenharmony_ci				 mox_module_table[id].desc);
3708c2ecf20Sopenharmony_ci
3718c2ecf20Sopenharmony_ci			if (moxtet_set_irq(moxtet, i-1, id, cnts[id]++) < 0)
3728c2ecf20Sopenharmony_ci				dev_err(moxtet->dev,
3738c2ecf20Sopenharmony_ci					"  Cannot set IRQ for module %s\n",
3748c2ecf20Sopenharmony_ci					mox_module_table[id].desc);
3758c2ecf20Sopenharmony_ci		} else {
3768c2ecf20Sopenharmony_ci			dev_warn(moxtet->dev,
3778c2ecf20Sopenharmony_ci				 "Unknown Moxtet module found (ID 0x%02x)\n",
3788c2ecf20Sopenharmony_ci				 id);
3798c2ecf20Sopenharmony_ci		}
3808c2ecf20Sopenharmony_ci	}
3818c2ecf20Sopenharmony_ci
3828c2ecf20Sopenharmony_ci	return 0;
3838c2ecf20Sopenharmony_ci}
3848c2ecf20Sopenharmony_ci
3858c2ecf20Sopenharmony_cistatic int moxtet_spi_read(struct moxtet *moxtet, u8 *buf)
3868c2ecf20Sopenharmony_ci{
3878c2ecf20Sopenharmony_ci	struct spi_transfer xfer = {
3888c2ecf20Sopenharmony_ci		.rx_buf = buf,
3898c2ecf20Sopenharmony_ci		.tx_buf = moxtet->tx,
3908c2ecf20Sopenharmony_ci		.len = moxtet->count + 1
3918c2ecf20Sopenharmony_ci	};
3928c2ecf20Sopenharmony_ci	int ret;
3938c2ecf20Sopenharmony_ci
3948c2ecf20Sopenharmony_ci	mutex_lock(&moxtet->lock);
3958c2ecf20Sopenharmony_ci
3968c2ecf20Sopenharmony_ci	ret = spi_sync_transfer(to_spi_device(moxtet->dev), &xfer, 1);
3978c2ecf20Sopenharmony_ci
3988c2ecf20Sopenharmony_ci	mutex_unlock(&moxtet->lock);
3998c2ecf20Sopenharmony_ci
4008c2ecf20Sopenharmony_ci	return ret;
4018c2ecf20Sopenharmony_ci}
4028c2ecf20Sopenharmony_ci
4038c2ecf20Sopenharmony_ciint moxtet_device_read(struct device *dev)
4048c2ecf20Sopenharmony_ci{
4058c2ecf20Sopenharmony_ci	struct moxtet_device *mdev = to_moxtet_device(dev);
4068c2ecf20Sopenharmony_ci	struct moxtet *moxtet = mdev->moxtet;
4078c2ecf20Sopenharmony_ci	u8 buf[TURRIS_MOX_MAX_MODULES];
4088c2ecf20Sopenharmony_ci	int ret;
4098c2ecf20Sopenharmony_ci
4108c2ecf20Sopenharmony_ci	if (mdev->idx >= moxtet->count)
4118c2ecf20Sopenharmony_ci		return -EINVAL;
4128c2ecf20Sopenharmony_ci
4138c2ecf20Sopenharmony_ci	ret = moxtet_spi_read(moxtet, buf);
4148c2ecf20Sopenharmony_ci	if (ret < 0)
4158c2ecf20Sopenharmony_ci		return ret;
4168c2ecf20Sopenharmony_ci
4178c2ecf20Sopenharmony_ci	return buf[mdev->idx + 1] >> 4;
4188c2ecf20Sopenharmony_ci}
4198c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(moxtet_device_read);
4208c2ecf20Sopenharmony_ci
4218c2ecf20Sopenharmony_ciint moxtet_device_write(struct device *dev, u8 val)
4228c2ecf20Sopenharmony_ci{
4238c2ecf20Sopenharmony_ci	struct moxtet_device *mdev = to_moxtet_device(dev);
4248c2ecf20Sopenharmony_ci	struct moxtet *moxtet = mdev->moxtet;
4258c2ecf20Sopenharmony_ci	int ret;
4268c2ecf20Sopenharmony_ci
4278c2ecf20Sopenharmony_ci	if (mdev->idx >= moxtet->count)
4288c2ecf20Sopenharmony_ci		return -EINVAL;
4298c2ecf20Sopenharmony_ci
4308c2ecf20Sopenharmony_ci	mutex_lock(&moxtet->lock);
4318c2ecf20Sopenharmony_ci
4328c2ecf20Sopenharmony_ci	moxtet->tx[moxtet->count - mdev->idx] = val;
4338c2ecf20Sopenharmony_ci
4348c2ecf20Sopenharmony_ci	ret = spi_write(to_spi_device(moxtet->dev), moxtet->tx,
4358c2ecf20Sopenharmony_ci			moxtet->count + 1);
4368c2ecf20Sopenharmony_ci
4378c2ecf20Sopenharmony_ci	mutex_unlock(&moxtet->lock);
4388c2ecf20Sopenharmony_ci
4398c2ecf20Sopenharmony_ci	return ret;
4408c2ecf20Sopenharmony_ci}
4418c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(moxtet_device_write);
4428c2ecf20Sopenharmony_ci
4438c2ecf20Sopenharmony_ciint moxtet_device_written(struct device *dev)
4448c2ecf20Sopenharmony_ci{
4458c2ecf20Sopenharmony_ci	struct moxtet_device *mdev = to_moxtet_device(dev);
4468c2ecf20Sopenharmony_ci	struct moxtet *moxtet = mdev->moxtet;
4478c2ecf20Sopenharmony_ci
4488c2ecf20Sopenharmony_ci	if (mdev->idx >= moxtet->count)
4498c2ecf20Sopenharmony_ci		return -EINVAL;
4508c2ecf20Sopenharmony_ci
4518c2ecf20Sopenharmony_ci	return moxtet->tx[moxtet->count - mdev->idx];
4528c2ecf20Sopenharmony_ci}
4538c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(moxtet_device_written);
4548c2ecf20Sopenharmony_ci
4558c2ecf20Sopenharmony_ci#ifdef CONFIG_DEBUG_FS
4568c2ecf20Sopenharmony_cistatic int moxtet_debug_open(struct inode *inode, struct file *file)
4578c2ecf20Sopenharmony_ci{
4588c2ecf20Sopenharmony_ci	file->private_data = inode->i_private;
4598c2ecf20Sopenharmony_ci
4608c2ecf20Sopenharmony_ci	return nonseekable_open(inode, file);
4618c2ecf20Sopenharmony_ci}
4628c2ecf20Sopenharmony_ci
4638c2ecf20Sopenharmony_cistatic ssize_t input_read(struct file *file, char __user *buf, size_t len,
4648c2ecf20Sopenharmony_ci			  loff_t *ppos)
4658c2ecf20Sopenharmony_ci{
4668c2ecf20Sopenharmony_ci	struct moxtet *moxtet = file->private_data;
4678c2ecf20Sopenharmony_ci	u8 bin[TURRIS_MOX_MAX_MODULES];
4688c2ecf20Sopenharmony_ci	u8 hex[sizeof(bin) * 2 + 1];
4698c2ecf20Sopenharmony_ci	int ret, n;
4708c2ecf20Sopenharmony_ci
4718c2ecf20Sopenharmony_ci	ret = moxtet_spi_read(moxtet, bin);
4728c2ecf20Sopenharmony_ci	if (ret < 0)
4738c2ecf20Sopenharmony_ci		return ret;
4748c2ecf20Sopenharmony_ci
4758c2ecf20Sopenharmony_ci	n = moxtet->count + 1;
4768c2ecf20Sopenharmony_ci	bin2hex(hex, bin, n);
4778c2ecf20Sopenharmony_ci
4788c2ecf20Sopenharmony_ci	hex[2*n] = '\n';
4798c2ecf20Sopenharmony_ci
4808c2ecf20Sopenharmony_ci	return simple_read_from_buffer(buf, len, ppos, hex, 2*n + 1);
4818c2ecf20Sopenharmony_ci}
4828c2ecf20Sopenharmony_ci
4838c2ecf20Sopenharmony_cistatic const struct file_operations input_fops = {
4848c2ecf20Sopenharmony_ci	.owner	= THIS_MODULE,
4858c2ecf20Sopenharmony_ci	.open	= moxtet_debug_open,
4868c2ecf20Sopenharmony_ci	.read	= input_read,
4878c2ecf20Sopenharmony_ci	.llseek	= no_llseek,
4888c2ecf20Sopenharmony_ci};
4898c2ecf20Sopenharmony_ci
4908c2ecf20Sopenharmony_cistatic ssize_t output_read(struct file *file, char __user *buf, size_t len,
4918c2ecf20Sopenharmony_ci			   loff_t *ppos)
4928c2ecf20Sopenharmony_ci{
4938c2ecf20Sopenharmony_ci	struct moxtet *moxtet = file->private_data;
4948c2ecf20Sopenharmony_ci	u8 hex[TURRIS_MOX_MAX_MODULES * 2 + 1];
4958c2ecf20Sopenharmony_ci	u8 *p = hex;
4968c2ecf20Sopenharmony_ci	int i;
4978c2ecf20Sopenharmony_ci
4988c2ecf20Sopenharmony_ci	mutex_lock(&moxtet->lock);
4998c2ecf20Sopenharmony_ci
5008c2ecf20Sopenharmony_ci	for (i = 0; i < moxtet->count; ++i)
5018c2ecf20Sopenharmony_ci		p = hex_byte_pack(p, moxtet->tx[moxtet->count - i]);
5028c2ecf20Sopenharmony_ci
5038c2ecf20Sopenharmony_ci	mutex_unlock(&moxtet->lock);
5048c2ecf20Sopenharmony_ci
5058c2ecf20Sopenharmony_ci	*p++ = '\n';
5068c2ecf20Sopenharmony_ci
5078c2ecf20Sopenharmony_ci	return simple_read_from_buffer(buf, len, ppos, hex, p - hex);
5088c2ecf20Sopenharmony_ci}
5098c2ecf20Sopenharmony_ci
5108c2ecf20Sopenharmony_cistatic ssize_t output_write(struct file *file, const char __user *buf,
5118c2ecf20Sopenharmony_ci			    size_t len, loff_t *ppos)
5128c2ecf20Sopenharmony_ci{
5138c2ecf20Sopenharmony_ci	struct moxtet *moxtet = file->private_data;
5148c2ecf20Sopenharmony_ci	u8 bin[TURRIS_MOX_MAX_MODULES];
5158c2ecf20Sopenharmony_ci	u8 hex[sizeof(bin) * 2 + 1];
5168c2ecf20Sopenharmony_ci	ssize_t res;
5178c2ecf20Sopenharmony_ci	loff_t dummy = 0;
5188c2ecf20Sopenharmony_ci	int err, i;
5198c2ecf20Sopenharmony_ci
5208c2ecf20Sopenharmony_ci	if (len > 2 * moxtet->count + 1 || len < 2 * moxtet->count)
5218c2ecf20Sopenharmony_ci		return -EINVAL;
5228c2ecf20Sopenharmony_ci
5238c2ecf20Sopenharmony_ci	res = simple_write_to_buffer(hex, sizeof(hex), &dummy, buf, len);
5248c2ecf20Sopenharmony_ci	if (res < 0)
5258c2ecf20Sopenharmony_ci		return res;
5268c2ecf20Sopenharmony_ci
5278c2ecf20Sopenharmony_ci	if (len % 2 == 1 && hex[len - 1] != '\n')
5288c2ecf20Sopenharmony_ci		return -EINVAL;
5298c2ecf20Sopenharmony_ci
5308c2ecf20Sopenharmony_ci	err = hex2bin(bin, hex, moxtet->count);
5318c2ecf20Sopenharmony_ci	if (err < 0)
5328c2ecf20Sopenharmony_ci		return -EINVAL;
5338c2ecf20Sopenharmony_ci
5348c2ecf20Sopenharmony_ci	mutex_lock(&moxtet->lock);
5358c2ecf20Sopenharmony_ci
5368c2ecf20Sopenharmony_ci	for (i = 0; i < moxtet->count; ++i)
5378c2ecf20Sopenharmony_ci		moxtet->tx[moxtet->count - i] = bin[i];
5388c2ecf20Sopenharmony_ci
5398c2ecf20Sopenharmony_ci	err = spi_write(to_spi_device(moxtet->dev), moxtet->tx,
5408c2ecf20Sopenharmony_ci			moxtet->count + 1);
5418c2ecf20Sopenharmony_ci
5428c2ecf20Sopenharmony_ci	mutex_unlock(&moxtet->lock);
5438c2ecf20Sopenharmony_ci
5448c2ecf20Sopenharmony_ci	return err < 0 ? err : len;
5458c2ecf20Sopenharmony_ci}
5468c2ecf20Sopenharmony_ci
5478c2ecf20Sopenharmony_cistatic const struct file_operations output_fops = {
5488c2ecf20Sopenharmony_ci	.owner	= THIS_MODULE,
5498c2ecf20Sopenharmony_ci	.open	= moxtet_debug_open,
5508c2ecf20Sopenharmony_ci	.read	= output_read,
5518c2ecf20Sopenharmony_ci	.write	= output_write,
5528c2ecf20Sopenharmony_ci	.llseek	= no_llseek,
5538c2ecf20Sopenharmony_ci};
5548c2ecf20Sopenharmony_ci
5558c2ecf20Sopenharmony_cistatic int moxtet_register_debugfs(struct moxtet *moxtet)
5568c2ecf20Sopenharmony_ci{
5578c2ecf20Sopenharmony_ci	struct dentry *root, *entry;
5588c2ecf20Sopenharmony_ci
5598c2ecf20Sopenharmony_ci	root = debugfs_create_dir("moxtet", NULL);
5608c2ecf20Sopenharmony_ci
5618c2ecf20Sopenharmony_ci	if (IS_ERR(root))
5628c2ecf20Sopenharmony_ci		return PTR_ERR(root);
5638c2ecf20Sopenharmony_ci
5648c2ecf20Sopenharmony_ci	entry = debugfs_create_file_unsafe("input", 0444, root, moxtet,
5658c2ecf20Sopenharmony_ci					   &input_fops);
5668c2ecf20Sopenharmony_ci	if (IS_ERR(entry))
5678c2ecf20Sopenharmony_ci		goto err_remove;
5688c2ecf20Sopenharmony_ci
5698c2ecf20Sopenharmony_ci	entry = debugfs_create_file_unsafe("output", 0644, root, moxtet,
5708c2ecf20Sopenharmony_ci					   &output_fops);
5718c2ecf20Sopenharmony_ci	if (IS_ERR(entry))
5728c2ecf20Sopenharmony_ci		goto err_remove;
5738c2ecf20Sopenharmony_ci
5748c2ecf20Sopenharmony_ci	moxtet->debugfs_root = root;
5758c2ecf20Sopenharmony_ci
5768c2ecf20Sopenharmony_ci	return 0;
5778c2ecf20Sopenharmony_cierr_remove:
5788c2ecf20Sopenharmony_ci	debugfs_remove_recursive(root);
5798c2ecf20Sopenharmony_ci	return PTR_ERR(entry);
5808c2ecf20Sopenharmony_ci}
5818c2ecf20Sopenharmony_ci
5828c2ecf20Sopenharmony_cistatic void moxtet_unregister_debugfs(struct moxtet *moxtet)
5838c2ecf20Sopenharmony_ci{
5848c2ecf20Sopenharmony_ci	debugfs_remove_recursive(moxtet->debugfs_root);
5858c2ecf20Sopenharmony_ci}
5868c2ecf20Sopenharmony_ci#else
5878c2ecf20Sopenharmony_cistatic inline int moxtet_register_debugfs(struct moxtet *moxtet)
5888c2ecf20Sopenharmony_ci{
5898c2ecf20Sopenharmony_ci	return 0;
5908c2ecf20Sopenharmony_ci}
5918c2ecf20Sopenharmony_ci
5928c2ecf20Sopenharmony_cistatic inline void moxtet_unregister_debugfs(struct moxtet *moxtet)
5938c2ecf20Sopenharmony_ci{
5948c2ecf20Sopenharmony_ci}
5958c2ecf20Sopenharmony_ci#endif
5968c2ecf20Sopenharmony_ci
5978c2ecf20Sopenharmony_cistatic int moxtet_irq_domain_map(struct irq_domain *d, unsigned int irq,
5988c2ecf20Sopenharmony_ci				 irq_hw_number_t hw)
5998c2ecf20Sopenharmony_ci{
6008c2ecf20Sopenharmony_ci	struct moxtet *moxtet = d->host_data;
6018c2ecf20Sopenharmony_ci
6028c2ecf20Sopenharmony_ci	if (hw >= MOXTET_NIRQS || !(moxtet->irq.exists & BIT(hw))) {
6038c2ecf20Sopenharmony_ci		dev_err(moxtet->dev, "Invalid hw irq number\n");
6048c2ecf20Sopenharmony_ci		return -EINVAL;
6058c2ecf20Sopenharmony_ci	}
6068c2ecf20Sopenharmony_ci
6078c2ecf20Sopenharmony_ci	irq_set_chip_data(irq, d->host_data);
6088c2ecf20Sopenharmony_ci	irq_set_chip_and_handler(irq, &moxtet->irq.chip, handle_level_irq);
6098c2ecf20Sopenharmony_ci
6108c2ecf20Sopenharmony_ci	return 0;
6118c2ecf20Sopenharmony_ci}
6128c2ecf20Sopenharmony_ci
6138c2ecf20Sopenharmony_cistatic int moxtet_irq_domain_xlate(struct irq_domain *d,
6148c2ecf20Sopenharmony_ci				   struct device_node *ctrlr,
6158c2ecf20Sopenharmony_ci				   const u32 *intspec, unsigned int intsize,
6168c2ecf20Sopenharmony_ci				   unsigned long *out_hwirq,
6178c2ecf20Sopenharmony_ci				   unsigned int *out_type)
6188c2ecf20Sopenharmony_ci{
6198c2ecf20Sopenharmony_ci	struct moxtet *moxtet = d->host_data;
6208c2ecf20Sopenharmony_ci	int irq;
6218c2ecf20Sopenharmony_ci
6228c2ecf20Sopenharmony_ci	if (WARN_ON(intsize < 1))
6238c2ecf20Sopenharmony_ci		return -EINVAL;
6248c2ecf20Sopenharmony_ci
6258c2ecf20Sopenharmony_ci	irq = intspec[0];
6268c2ecf20Sopenharmony_ci
6278c2ecf20Sopenharmony_ci	if (irq >= MOXTET_NIRQS || !(moxtet->irq.exists & BIT(irq)))
6288c2ecf20Sopenharmony_ci		return -EINVAL;
6298c2ecf20Sopenharmony_ci
6308c2ecf20Sopenharmony_ci	*out_hwirq = irq;
6318c2ecf20Sopenharmony_ci	*out_type = IRQ_TYPE_NONE;
6328c2ecf20Sopenharmony_ci	return 0;
6338c2ecf20Sopenharmony_ci}
6348c2ecf20Sopenharmony_ci
6358c2ecf20Sopenharmony_cistatic const struct irq_domain_ops moxtet_irq_domain = {
6368c2ecf20Sopenharmony_ci	.map = moxtet_irq_domain_map,
6378c2ecf20Sopenharmony_ci	.xlate = moxtet_irq_domain_xlate,
6388c2ecf20Sopenharmony_ci};
6398c2ecf20Sopenharmony_ci
6408c2ecf20Sopenharmony_cistatic void moxtet_irq_mask(struct irq_data *d)
6418c2ecf20Sopenharmony_ci{
6428c2ecf20Sopenharmony_ci	struct moxtet *moxtet = irq_data_get_irq_chip_data(d);
6438c2ecf20Sopenharmony_ci
6448c2ecf20Sopenharmony_ci	moxtet->irq.masked |= BIT(d->hwirq);
6458c2ecf20Sopenharmony_ci}
6468c2ecf20Sopenharmony_ci
6478c2ecf20Sopenharmony_cistatic void moxtet_irq_unmask(struct irq_data *d)
6488c2ecf20Sopenharmony_ci{
6498c2ecf20Sopenharmony_ci	struct moxtet *moxtet = irq_data_get_irq_chip_data(d);
6508c2ecf20Sopenharmony_ci
6518c2ecf20Sopenharmony_ci	moxtet->irq.masked &= ~BIT(d->hwirq);
6528c2ecf20Sopenharmony_ci}
6538c2ecf20Sopenharmony_ci
6548c2ecf20Sopenharmony_cistatic void moxtet_irq_print_chip(struct irq_data *d, struct seq_file *p)
6558c2ecf20Sopenharmony_ci{
6568c2ecf20Sopenharmony_ci	struct moxtet *moxtet = irq_data_get_irq_chip_data(d);
6578c2ecf20Sopenharmony_ci	struct moxtet_irqpos *pos = &moxtet->irq.position[d->hwirq];
6588c2ecf20Sopenharmony_ci	int id;
6598c2ecf20Sopenharmony_ci
6608c2ecf20Sopenharmony_ci	id = moxtet->modules[pos->idx];
6618c2ecf20Sopenharmony_ci
6628c2ecf20Sopenharmony_ci	seq_printf(p, " moxtet-%s.%i#%i", mox_module_name(id), pos->idx,
6638c2ecf20Sopenharmony_ci		   pos->bit);
6648c2ecf20Sopenharmony_ci}
6658c2ecf20Sopenharmony_ci
6668c2ecf20Sopenharmony_cistatic const struct irq_chip moxtet_irq_chip = {
6678c2ecf20Sopenharmony_ci	.name			= "moxtet",
6688c2ecf20Sopenharmony_ci	.irq_mask		= moxtet_irq_mask,
6698c2ecf20Sopenharmony_ci	.irq_unmask		= moxtet_irq_unmask,
6708c2ecf20Sopenharmony_ci	.irq_print_chip		= moxtet_irq_print_chip,
6718c2ecf20Sopenharmony_ci};
6728c2ecf20Sopenharmony_ci
6738c2ecf20Sopenharmony_cistatic int moxtet_irq_read(struct moxtet *moxtet, unsigned long *map)
6748c2ecf20Sopenharmony_ci{
6758c2ecf20Sopenharmony_ci	struct moxtet_irqpos *pos = moxtet->irq.position;
6768c2ecf20Sopenharmony_ci	u8 buf[TURRIS_MOX_MAX_MODULES];
6778c2ecf20Sopenharmony_ci	int i, ret;
6788c2ecf20Sopenharmony_ci
6798c2ecf20Sopenharmony_ci	ret = moxtet_spi_read(moxtet, buf);
6808c2ecf20Sopenharmony_ci	if (ret < 0)
6818c2ecf20Sopenharmony_ci		return ret;
6828c2ecf20Sopenharmony_ci
6838c2ecf20Sopenharmony_ci	*map = 0;
6848c2ecf20Sopenharmony_ci
6858c2ecf20Sopenharmony_ci	for_each_set_bit(i, &moxtet->irq.exists, MOXTET_NIRQS) {
6868c2ecf20Sopenharmony_ci		if (!(buf[pos[i].idx + 1] & BIT(4 + pos[i].bit)))
6878c2ecf20Sopenharmony_ci			set_bit(i, map);
6888c2ecf20Sopenharmony_ci	}
6898c2ecf20Sopenharmony_ci
6908c2ecf20Sopenharmony_ci	return 0;
6918c2ecf20Sopenharmony_ci}
6928c2ecf20Sopenharmony_ci
6938c2ecf20Sopenharmony_cistatic irqreturn_t moxtet_irq_thread_fn(int irq, void *data)
6948c2ecf20Sopenharmony_ci{
6958c2ecf20Sopenharmony_ci	struct moxtet *moxtet = data;
6968c2ecf20Sopenharmony_ci	unsigned long set;
6978c2ecf20Sopenharmony_ci	int nhandled = 0, i, sub_irq, ret;
6988c2ecf20Sopenharmony_ci
6998c2ecf20Sopenharmony_ci	ret = moxtet_irq_read(moxtet, &set);
7008c2ecf20Sopenharmony_ci	if (ret < 0)
7018c2ecf20Sopenharmony_ci		goto out;
7028c2ecf20Sopenharmony_ci
7038c2ecf20Sopenharmony_ci	set &= ~moxtet->irq.masked;
7048c2ecf20Sopenharmony_ci
7058c2ecf20Sopenharmony_ci	do {
7068c2ecf20Sopenharmony_ci		for_each_set_bit(i, &set, MOXTET_NIRQS) {
7078c2ecf20Sopenharmony_ci			sub_irq = irq_find_mapping(moxtet->irq.domain, i);
7088c2ecf20Sopenharmony_ci			handle_nested_irq(sub_irq);
7098c2ecf20Sopenharmony_ci			dev_dbg(moxtet->dev, "%i irq\n", i);
7108c2ecf20Sopenharmony_ci			++nhandled;
7118c2ecf20Sopenharmony_ci		}
7128c2ecf20Sopenharmony_ci
7138c2ecf20Sopenharmony_ci		ret = moxtet_irq_read(moxtet, &set);
7148c2ecf20Sopenharmony_ci		if (ret < 0)
7158c2ecf20Sopenharmony_ci			goto out;
7168c2ecf20Sopenharmony_ci
7178c2ecf20Sopenharmony_ci		set &= ~moxtet->irq.masked;
7188c2ecf20Sopenharmony_ci	} while (set);
7198c2ecf20Sopenharmony_ci
7208c2ecf20Sopenharmony_ciout:
7218c2ecf20Sopenharmony_ci	return (nhandled > 0 ? IRQ_HANDLED : IRQ_NONE);
7228c2ecf20Sopenharmony_ci}
7238c2ecf20Sopenharmony_ci
7248c2ecf20Sopenharmony_cistatic void moxtet_irq_free(struct moxtet *moxtet)
7258c2ecf20Sopenharmony_ci{
7268c2ecf20Sopenharmony_ci	int i, irq;
7278c2ecf20Sopenharmony_ci
7288c2ecf20Sopenharmony_ci	for (i = 0; i < MOXTET_NIRQS; ++i) {
7298c2ecf20Sopenharmony_ci		if (moxtet->irq.exists & BIT(i)) {
7308c2ecf20Sopenharmony_ci			irq = irq_find_mapping(moxtet->irq.domain, i);
7318c2ecf20Sopenharmony_ci			irq_dispose_mapping(irq);
7328c2ecf20Sopenharmony_ci		}
7338c2ecf20Sopenharmony_ci	}
7348c2ecf20Sopenharmony_ci
7358c2ecf20Sopenharmony_ci	irq_domain_remove(moxtet->irq.domain);
7368c2ecf20Sopenharmony_ci}
7378c2ecf20Sopenharmony_ci
7388c2ecf20Sopenharmony_cistatic int moxtet_irq_setup(struct moxtet *moxtet)
7398c2ecf20Sopenharmony_ci{
7408c2ecf20Sopenharmony_ci	int i, ret;
7418c2ecf20Sopenharmony_ci
7428c2ecf20Sopenharmony_ci	moxtet->irq.domain = irq_domain_add_simple(moxtet->dev->of_node,
7438c2ecf20Sopenharmony_ci						   MOXTET_NIRQS, 0,
7448c2ecf20Sopenharmony_ci						   &moxtet_irq_domain, moxtet);
7458c2ecf20Sopenharmony_ci	if (moxtet->irq.domain == NULL) {
7468c2ecf20Sopenharmony_ci		dev_err(moxtet->dev, "Could not add IRQ domain\n");
7478c2ecf20Sopenharmony_ci		return -ENOMEM;
7488c2ecf20Sopenharmony_ci	}
7498c2ecf20Sopenharmony_ci
7508c2ecf20Sopenharmony_ci	for (i = 0; i < MOXTET_NIRQS; ++i)
7518c2ecf20Sopenharmony_ci		if (moxtet->irq.exists & BIT(i))
7528c2ecf20Sopenharmony_ci			irq_create_mapping(moxtet->irq.domain, i);
7538c2ecf20Sopenharmony_ci
7548c2ecf20Sopenharmony_ci	moxtet->irq.chip = moxtet_irq_chip;
7558c2ecf20Sopenharmony_ci	moxtet->irq.masked = ~0;
7568c2ecf20Sopenharmony_ci
7578c2ecf20Sopenharmony_ci	ret = request_threaded_irq(moxtet->dev_irq, NULL, moxtet_irq_thread_fn,
7588c2ecf20Sopenharmony_ci				   IRQF_ONESHOT, "moxtet", moxtet);
7598c2ecf20Sopenharmony_ci	if (ret < 0)
7608c2ecf20Sopenharmony_ci		goto err_free;
7618c2ecf20Sopenharmony_ci
7628c2ecf20Sopenharmony_ci	return 0;
7638c2ecf20Sopenharmony_ci
7648c2ecf20Sopenharmony_cierr_free:
7658c2ecf20Sopenharmony_ci	moxtet_irq_free(moxtet);
7668c2ecf20Sopenharmony_ci	return ret;
7678c2ecf20Sopenharmony_ci}
7688c2ecf20Sopenharmony_ci
7698c2ecf20Sopenharmony_cistatic int moxtet_probe(struct spi_device *spi)
7708c2ecf20Sopenharmony_ci{
7718c2ecf20Sopenharmony_ci	struct moxtet *moxtet;
7728c2ecf20Sopenharmony_ci	int ret;
7738c2ecf20Sopenharmony_ci
7748c2ecf20Sopenharmony_ci	ret = spi_setup(spi);
7758c2ecf20Sopenharmony_ci	if (ret < 0)
7768c2ecf20Sopenharmony_ci		return ret;
7778c2ecf20Sopenharmony_ci
7788c2ecf20Sopenharmony_ci	moxtet = devm_kzalloc(&spi->dev, sizeof(struct moxtet),
7798c2ecf20Sopenharmony_ci			      GFP_KERNEL);
7808c2ecf20Sopenharmony_ci	if (!moxtet)
7818c2ecf20Sopenharmony_ci		return -ENOMEM;
7828c2ecf20Sopenharmony_ci
7838c2ecf20Sopenharmony_ci	moxtet->dev = &spi->dev;
7848c2ecf20Sopenharmony_ci	spi_set_drvdata(spi, moxtet);
7858c2ecf20Sopenharmony_ci
7868c2ecf20Sopenharmony_ci	mutex_init(&moxtet->lock);
7878c2ecf20Sopenharmony_ci
7888c2ecf20Sopenharmony_ci	moxtet->dev_irq = of_irq_get(moxtet->dev->of_node, 0);
7898c2ecf20Sopenharmony_ci	if (moxtet->dev_irq == -EPROBE_DEFER)
7908c2ecf20Sopenharmony_ci		return -EPROBE_DEFER;
7918c2ecf20Sopenharmony_ci
7928c2ecf20Sopenharmony_ci	if (moxtet->dev_irq <= 0) {
7938c2ecf20Sopenharmony_ci		dev_err(moxtet->dev, "No IRQ resource found\n");
7948c2ecf20Sopenharmony_ci		return -ENXIO;
7958c2ecf20Sopenharmony_ci	}
7968c2ecf20Sopenharmony_ci
7978c2ecf20Sopenharmony_ci	ret = moxtet_find_topology(moxtet);
7988c2ecf20Sopenharmony_ci	if (ret < 0)
7998c2ecf20Sopenharmony_ci		return ret;
8008c2ecf20Sopenharmony_ci
8018c2ecf20Sopenharmony_ci	if (moxtet->irq.exists) {
8028c2ecf20Sopenharmony_ci		ret = moxtet_irq_setup(moxtet);
8038c2ecf20Sopenharmony_ci		if (ret < 0)
8048c2ecf20Sopenharmony_ci			return ret;
8058c2ecf20Sopenharmony_ci	}
8068c2ecf20Sopenharmony_ci
8078c2ecf20Sopenharmony_ci	of_register_moxtet_devices(moxtet);
8088c2ecf20Sopenharmony_ci	moxtet_register_devices_from_topology(moxtet);
8098c2ecf20Sopenharmony_ci
8108c2ecf20Sopenharmony_ci	ret = moxtet_register_debugfs(moxtet);
8118c2ecf20Sopenharmony_ci	if (ret < 0)
8128c2ecf20Sopenharmony_ci		dev_warn(moxtet->dev, "Failed creating debugfs entries: %i\n",
8138c2ecf20Sopenharmony_ci			 ret);
8148c2ecf20Sopenharmony_ci
8158c2ecf20Sopenharmony_ci	return 0;
8168c2ecf20Sopenharmony_ci}
8178c2ecf20Sopenharmony_ci
8188c2ecf20Sopenharmony_cistatic int moxtet_remove(struct spi_device *spi)
8198c2ecf20Sopenharmony_ci{
8208c2ecf20Sopenharmony_ci	struct moxtet *moxtet = spi_get_drvdata(spi);
8218c2ecf20Sopenharmony_ci
8228c2ecf20Sopenharmony_ci	free_irq(moxtet->dev_irq, moxtet);
8238c2ecf20Sopenharmony_ci
8248c2ecf20Sopenharmony_ci	moxtet_irq_free(moxtet);
8258c2ecf20Sopenharmony_ci
8268c2ecf20Sopenharmony_ci	moxtet_unregister_debugfs(moxtet);
8278c2ecf20Sopenharmony_ci
8288c2ecf20Sopenharmony_ci	device_for_each_child(moxtet->dev, NULL, __unregister);
8298c2ecf20Sopenharmony_ci
8308c2ecf20Sopenharmony_ci	mutex_destroy(&moxtet->lock);
8318c2ecf20Sopenharmony_ci
8328c2ecf20Sopenharmony_ci	return 0;
8338c2ecf20Sopenharmony_ci}
8348c2ecf20Sopenharmony_ci
8358c2ecf20Sopenharmony_cistatic const struct spi_device_id moxtet_spi_ids[] = {
8368c2ecf20Sopenharmony_ci	{ "moxtet" },
8378c2ecf20Sopenharmony_ci	{ },
8388c2ecf20Sopenharmony_ci};
8398c2ecf20Sopenharmony_ciMODULE_DEVICE_TABLE(spi, moxtet_spi_ids);
8408c2ecf20Sopenharmony_ci
8418c2ecf20Sopenharmony_cistatic const struct of_device_id moxtet_dt_ids[] = {
8428c2ecf20Sopenharmony_ci	{ .compatible = "cznic,moxtet" },
8438c2ecf20Sopenharmony_ci	{},
8448c2ecf20Sopenharmony_ci};
8458c2ecf20Sopenharmony_ciMODULE_DEVICE_TABLE(of, moxtet_dt_ids);
8468c2ecf20Sopenharmony_ci
8478c2ecf20Sopenharmony_cistatic struct spi_driver moxtet_spi_driver = {
8488c2ecf20Sopenharmony_ci	.driver = {
8498c2ecf20Sopenharmony_ci		.name		= "moxtet",
8508c2ecf20Sopenharmony_ci		.of_match_table = moxtet_dt_ids,
8518c2ecf20Sopenharmony_ci	},
8528c2ecf20Sopenharmony_ci	.id_table	= moxtet_spi_ids,
8538c2ecf20Sopenharmony_ci	.probe		= moxtet_probe,
8548c2ecf20Sopenharmony_ci	.remove		= moxtet_remove,
8558c2ecf20Sopenharmony_ci};
8568c2ecf20Sopenharmony_ci
8578c2ecf20Sopenharmony_cistatic int __init moxtet_init(void)
8588c2ecf20Sopenharmony_ci{
8598c2ecf20Sopenharmony_ci	int ret;
8608c2ecf20Sopenharmony_ci
8618c2ecf20Sopenharmony_ci	ret = bus_register(&moxtet_bus_type);
8628c2ecf20Sopenharmony_ci	if (ret < 0) {
8638c2ecf20Sopenharmony_ci		pr_err("moxtet bus registration failed: %d\n", ret);
8648c2ecf20Sopenharmony_ci		goto error;
8658c2ecf20Sopenharmony_ci	}
8668c2ecf20Sopenharmony_ci
8678c2ecf20Sopenharmony_ci	ret = spi_register_driver(&moxtet_spi_driver);
8688c2ecf20Sopenharmony_ci	if (ret < 0) {
8698c2ecf20Sopenharmony_ci		pr_err("moxtet spi driver registration failed: %d\n", ret);
8708c2ecf20Sopenharmony_ci		goto error_bus;
8718c2ecf20Sopenharmony_ci	}
8728c2ecf20Sopenharmony_ci
8738c2ecf20Sopenharmony_ci	return 0;
8748c2ecf20Sopenharmony_ci
8758c2ecf20Sopenharmony_cierror_bus:
8768c2ecf20Sopenharmony_ci	bus_unregister(&moxtet_bus_type);
8778c2ecf20Sopenharmony_cierror:
8788c2ecf20Sopenharmony_ci	return ret;
8798c2ecf20Sopenharmony_ci}
8808c2ecf20Sopenharmony_cipostcore_initcall_sync(moxtet_init);
8818c2ecf20Sopenharmony_ci
8828c2ecf20Sopenharmony_cistatic void __exit moxtet_exit(void)
8838c2ecf20Sopenharmony_ci{
8848c2ecf20Sopenharmony_ci	spi_unregister_driver(&moxtet_spi_driver);
8858c2ecf20Sopenharmony_ci	bus_unregister(&moxtet_bus_type);
8868c2ecf20Sopenharmony_ci}
8878c2ecf20Sopenharmony_cimodule_exit(moxtet_exit);
8888c2ecf20Sopenharmony_ci
8898c2ecf20Sopenharmony_ciMODULE_AUTHOR("Marek Behun <marek.behun@nic.cz>");
8908c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("CZ.NIC's Turris Mox module configuration bus");
8918c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL v2");
892