[linux-2.6-block.git] / sound / soc / fsl / imx-audmux.c

// SPDX-License-Identifier: GPL-2.0+
//
// Copyright 2012 Freescale Semiconductor, Inc.
// Copyright 2012 Linaro Ltd.
// Copyright 2009 Pengutronix, Sascha Hauer <s.hauer@pengutronix.de>
//
// Initial development of this code was funded by
// Phytec Messtechnik GmbH, http://www.phytec.de

#include <linux/clk.h>
#include <linux/debugfs.h>
#include <linux/err.h>
#include <linux/io.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/of_device.h>
#include <linux/platform_device.h>
#include <linux/slab.h>

#include "imx-audmux.h"

#define DRIVER_NAME "imx-audmux"

static struct clk *audmux_clk;
static void __iomem *audmux_base;

#define IMX_AUDMUX_V2_PTCR(x)		((x) * 8)
#define IMX_AUDMUX_V2_PDCR(x)		((x) * 8 + 4)

#ifdef CONFIG_DEBUG_FS
static struct dentry *audmux_debugfs_root;

/* There is an annoying discontinuity in the SSI numbering with regard
 * to the Linux number of the devices */
static const char *audmux_port_string(int port)
{
	switch (port) {
	case MX31_AUDMUX_PORT1_SSI0:
		return "imx-ssi.0";
	case MX31_AUDMUX_PORT2_SSI1:
		return "imx-ssi.1";
	case MX31_AUDMUX_PORT3_SSI_PINS_3:
		return "SSI3";
	case MX31_AUDMUX_PORT4_SSI_PINS_4:
		return "SSI4";
	case MX31_AUDMUX_PORT5_SSI_PINS_5:
		return "SSI5";
	case MX31_AUDMUX_PORT6_SSI_PINS_6:
		return "SSI6";
	default:
		return "UNKNOWN";
	}
}

static ssize_t audmux_read_file(struct file *file, char __user *user_buf,
				size_t count, loff_t *ppos)
{
	ssize_t ret;
	char *buf;
	uintptr_t port = (uintptr_t)file->private_data;
	u32 pdcr, ptcr;

	if (audmux_clk) {
		ret = clk_prepare_enable(audmux_clk);
		if (ret)
			return ret;
	}

	ptcr = readl(audmux_base + IMX_AUDMUX_V2_PTCR(port));
	pdcr = readl(audmux_base + IMX_AUDMUX_V2_PDCR(port));

	if (audmux_clk)
		clk_disable_unprepare(audmux_clk);

	buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
	if (!buf)
		return -ENOMEM;

	ret = scnprintf(buf, PAGE_SIZE, "PDCR: %08x\nPTCR: %08x\n",
		       pdcr, ptcr);

	if (ptcr & IMX_AUDMUX_V2_PTCR_TFSDIR)
		ret += scnprintf(buf + ret, PAGE_SIZE - ret,
				"TxFS output from %s, ",
				audmux_port_string((ptcr >> 27) & 0x7));
	else
		ret += scnprintf(buf + ret, PAGE_SIZE - ret,
				"TxFS input, ");

	if (ptcr & IMX_AUDMUX_V2_PTCR_TCLKDIR)
		ret += scnprintf(buf + ret, PAGE_SIZE - ret,
				"TxClk output from %s",
				audmux_port_string((ptcr >> 22) & 0x7));
	else
		ret += scnprintf(buf + ret, PAGE_SIZE - ret,
				"TxClk input");

	ret += scnprintf(buf + ret, PAGE_SIZE - ret, "\n");

	if (ptcr & IMX_AUDMUX_V2_PTCR_SYN) {
		ret += scnprintf(buf + ret, PAGE_SIZE - ret,
				"Port is symmetric");
	} else {
		if (ptcr & IMX_AUDMUX_V2_PTCR_RFSDIR)
			ret += scnprintf(buf + ret, PAGE_SIZE - ret,
					"RxFS output from %s, ",
					audmux_port_string((ptcr >> 17) & 0x7));
		else
			ret += scnprintf(buf + ret, PAGE_SIZE - ret,
					"RxFS input, ");

		if (ptcr & IMX_AUDMUX_V2_PTCR_RCLKDIR)
			ret += scnprintf(buf + ret, PAGE_SIZE - ret,
					"RxClk output from %s",
					audmux_port_string((ptcr >> 12) & 0x7));
		else
			ret += scnprintf(buf + ret, PAGE_SIZE - ret,
					"RxClk input");
	}

	ret += scnprintf(buf + ret, PAGE_SIZE - ret,
			"\nData received from %s\n",
			audmux_port_string((pdcr >> 13) & 0x7));

	ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);

	kfree(buf);

	return ret;
}

static const struct file_operations audmux_debugfs_fops = {
	.open = simple_open,
	.read = audmux_read_file,
	.llseek = default_llseek,
};

static void audmux_debugfs_init(void)
{
	uintptr_t i;
	char buf[20];

	audmux_debugfs_root = debugfs_create_dir("audmux", NULL);
	if (!audmux_debugfs_root) {
		pr_warning("Failed to create AUDMUX debugfs root\n");
		return;
	}

	for (i = 0; i < MX31_AUDMUX_PORT7_SSI_PINS_7 + 1; i++) {
		snprintf(buf, sizeof(buf), "ssi%lu", i);
		if (!debugfs_create_file(buf, 0444, audmux_debugfs_root,
					 (void *)i, &audmux_debugfs_fops))
			pr_warning("Failed to create AUDMUX port %lu debugfs file\n",
				   i);
	}
}

static void audmux_debugfs_remove(void)
{
	debugfs_remove_recursive(audmux_debugfs_root);
}
#else
static inline void audmux_debugfs_init(void)
{
}

static inline void audmux_debugfs_remove(void)
{
}
#endif

static enum imx_audmux_type {
	IMX21_AUDMUX,
	IMX31_AUDMUX,
} audmux_type;

static const struct platform_device_id imx_audmux_ids[] = {
	{
		.name = "imx21-audmux",
		.driver_data = IMX21_AUDMUX,
	}, {
		.name = "imx31-audmux",
		.driver_data = IMX31_AUDMUX,
	}, {
		/* sentinel */
	}
};
MODULE_DEVICE_TABLE(platform, imx_audmux_ids);

static const struct of_device_id imx_audmux_dt_ids[] = {
	{ .compatible = "fsl,imx21-audmux", .data = &imx_audmux_ids[0], },
	{ .compatible = "fsl,imx31-audmux", .data = &imx_audmux_ids[1], },
	{ /* sentinel */ }
};
MODULE_DEVICE_TABLE(of, imx_audmux_dt_ids);

static const uint8_t port_mapping[] = {
	0x0, 0x4, 0x8, 0x10, 0x14, 0x1c,
};

int imx_audmux_v1_configure_port(unsigned int port, unsigned int pcr)
{
	if (audmux_type != IMX21_AUDMUX)
		return -EINVAL;

	if (!audmux_base)
		return -ENOSYS;

	if (port >= ARRAY_SIZE(port_mapping))
		return -EINVAL;

	writel(pcr, audmux_base + port_mapping[port]);

	return 0;
}
EXPORT_SYMBOL_GPL(imx_audmux_v1_configure_port);

int imx_audmux_v2_configure_port(unsigned int port, unsigned int ptcr,
		unsigned int pdcr)
{
	int ret;

	if (audmux_type != IMX31_AUDMUX)
		return -EINVAL;

	if (!audmux_base)
		return -ENOSYS;

	if (audmux_clk) {
		ret = clk_prepare_enable(audmux_clk);
		if (ret)
			return ret;
	}

	writel(ptcr, audmux_base + IMX_AUDMUX_V2_PTCR(port));
	writel(pdcr, audmux_base + IMX_AUDMUX_V2_PDCR(port));

	if (audmux_clk)
		clk_disable_unprepare(audmux_clk);

	return 0;
}
EXPORT_SYMBOL_GPL(imx_audmux_v2_configure_port);

static int imx_audmux_parse_dt_defaults(struct platform_device *pdev,
		struct device_node *of_node)
{
	struct device_node *child;

	for_each_available_child_of_node(of_node, child) {
		unsigned int port;
		unsigned int ptcr = 0;
		unsigned int pdcr = 0;
		unsigned int pcr = 0;
		unsigned int val;
		int ret;
		int i = 0;

		ret = of_property_read_u32(child, "fsl,audmux-port", &port);
		if (ret) {
			dev_warn(&pdev->dev, "Failed to get fsl,audmux-port of child node \"%pOF\"\n",
					child);
			continue;
		}
		if (!of_property_read_bool(child, "fsl,port-config")) {
			dev_warn(&pdev->dev, "child node \"%pOF\" does not have property fsl,port-config\n",
					child);
			continue;
		}

		for (i = 0; (ret = of_property_read_u32_index(child,
					"fsl,port-config", i, &val)) == 0;
				++i) {
			if (audmux_type == IMX31_AUDMUX) {
				if (i % 2)
					pdcr |= val;
				else
					ptcr |= val;
			} else {
				pcr |= val;
			}
		}

		if (ret != -EOVERFLOW) {
			dev_err(&pdev->dev, "Failed to read u32 at index %d of child %pOF\n",
					i, child);
			continue;
		}

		if (audmux_type == IMX31_AUDMUX) {
			if (i % 2) {
				dev_err(&pdev->dev, "One pdcr value is missing in child node %pOF\n",
						child);
				continue;
			}
			imx_audmux_v2_configure_port(port, ptcr, pdcr);
		} else {
			imx_audmux_v1_configure_port(port, pcr);
		}
	}

	return 0;
}

static int imx_audmux_probe(struct platform_device *pdev)
{
	struct resource *res;
	const struct of_device_id *of_id =
			of_match_device(imx_audmux_dt_ids, &pdev->dev);

	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	audmux_base = devm_ioremap_resource(&pdev->dev, res);
	if (IS_ERR(audmux_base))
		return PTR_ERR(audmux_base);

	audmux_clk = devm_clk_get(&pdev->dev, "audmux");
	if (IS_ERR(audmux_clk)) {
		dev_dbg(&pdev->dev, "cannot get clock: %ld\n",
				PTR_ERR(audmux_clk));
		audmux_clk = NULL;
	}

	if (of_id)
		pdev->id_entry = of_id->data;
	audmux_type = pdev->id_entry->driver_data;
	if (audmux_type == IMX31_AUDMUX)
		audmux_debugfs_init();

	if (of_id)
		imx_audmux_parse_dt_defaults(pdev, pdev->dev.of_node);

	return 0;
}

static int imx_audmux_remove(struct platform_device *pdev)
{
	if (audmux_type == IMX31_AUDMUX)
		audmux_debugfs_remove();

	return 0;
}

static struct platform_driver imx_audmux_driver = {
	.probe		= imx_audmux_probe,
	.remove		= imx_audmux_remove,
	.id_table	= imx_audmux_ids,
	.driver	= {
		.name	= DRIVER_NAME,
		.of_match_table = imx_audmux_dt_ids,
	}
};

static int __init imx_audmux_init(void)
{
	return platform_driver_register(&imx_audmux_driver);
}
subsys_initcall(imx_audmux_init);

static void __exit imx_audmux_exit(void)
{
	platform_driver_unregister(&imx_audmux_driver);
}
module_exit(imx_audmux_exit);

MODULE_DESCRIPTION("Freescale i.MX AUDMUX driver");
MODULE_AUTHOR("Sascha Hauer <s.hauer@pengutronix.de>");
MODULE_LICENSE("GPL v2");
MODULE_ALIAS("platform:" DRIVER_NAME);
Commit	Line	Data
47bbcbfe AD	1	// SPDX-License-Identifier: GPL-2.0+
	2	//
	3	// Copyright 2012 Freescale Semiconductor, Inc.
	4	// Copyright 2012 Linaro Ltd.
	5	// Copyright 2009 Pengutronix, Sascha Hauer <s.hauer@pengutronix.de>
	6	//
	7	// Initial development of this code was funded by
	8	// Phytec Messtechnik GmbH, http://www.phytec.de
9eedbdf1	9
9eedbdf1	10	#include <linux/clk.h>
7b4e08a7	11	#include <linux/debugfs.h>
3bc34a61 RZ	12	#include <linux/err.h>
	13	#include <linux/io.h>
	14	#include <linux/module.h>
9d5ef266 RZ	15	#include <linux/of.h>
9d5ef266 RZ	16	#include <linux/of_device.h>
3bc34a61	17	#include <linux/platform_device.h>
5a0e3ad6	18	#include <linux/slab.h>
3c77c29c SG	19
3c77c29c SG	20	#include "imx-audmux.h"
3bc34a61 RZ	21
3bc34a61 RZ	22	#define DRIVER_NAME "imx-audmux"
9eedbdf1 SH	23
	24	static struct clk *audmux_clk;
	25	static void __iomem *audmux_base;
	26
af4872fb SG	27	#define IMX_AUDMUX_V2_PTCR(x) ((x) * 8)
af4872fb SG	28	#define IMX_AUDMUX_V2_PDCR(x) ((x) * 8 + 4)
9eedbdf1	29
7b4e08a7 MB	30	#ifdef CONFIG_DEBUG_FS
	31	static struct dentry *audmux_debugfs_root;
	32
7b4e08a7 MB	33	/* There is an annoying discontinuity in the SSI numbering with regard
	34	* to the Linux number of the devices */
	35	static const char *audmux_port_string(int port)
	36	{
	37	switch (port) {
	38	case MX31_AUDMUX_PORT1_SSI0:
	39	return "imx-ssi.0";
	40	case MX31_AUDMUX_PORT2_SSI1:
	41	return "imx-ssi.1";
	42	case MX31_AUDMUX_PORT3_SSI_PINS_3:
	43	return "SSI3";
	44	case MX31_AUDMUX_PORT4_SSI_PINS_4:
	45	return "SSI4";
	46	case MX31_AUDMUX_PORT5_SSI_PINS_5:
	47	return "SSI5";
	48	case MX31_AUDMUX_PORT6_SSI_PINS_6:
	49	return "SSI6";
	50	default:
	51	return "UNKNOWN";
	52	}
	53	}
	54
	55	static ssize_t audmux_read_file(struct file file, char __user user_buf,
	56	size_t count, loff_t *ppos)
	57	{
	58	ssize_t ret;
1b3ed70a	59	char *buf;
e5f89768	60	uintptr_t port = (uintptr_t)file->private_data;
7b4e08a7 MB	61	u32 pdcr, ptcr;
7b4e08a7 MB	62
72192366 FE	63	if (audmux_clk) {
	64	ret = clk_prepare_enable(audmux_clk);
	65	if (ret)
	66	return ret;
	67	}
7b4e08a7	68
af4872fb SG	69	ptcr = readl(audmux_base + IMX_AUDMUX_V2_PTCR(port));
af4872fb SG	70	pdcr = readl(audmux_base + IMX_AUDMUX_V2_PDCR(port));
7b4e08a7 MB	71
7b4e08a7 MB	72	if (audmux_clk)
bac59328	73	clk_disable_unprepare(audmux_clk);
7b4e08a7	74
1b3ed70a FP	75	buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
	76	if (!buf)
	77	return -ENOMEM;
	78
c407cd00	79	ret = scnprintf(buf, PAGE_SIZE, "PDCR: %08x\nPTCR: %08x\n",
7b4e08a7 MB	80	pdcr, ptcr);
7b4e08a7 MB	81
af4872fb	82	if (ptcr & IMX_AUDMUX_V2_PTCR_TFSDIR)
c407cd00	83	ret += scnprintf(buf + ret, PAGE_SIZE - ret,
7b4e08a7 MB	84	"TxFS output from %s, ",
	85	audmux_port_string((ptcr >> 27) & 0x7));
	86	else
c407cd00	87	ret += scnprintf(buf + ret, PAGE_SIZE - ret,
7b4e08a7 MB	88	"TxFS input, ");
7b4e08a7 MB	89
af4872fb	90	if (ptcr & IMX_AUDMUX_V2_PTCR_TCLKDIR)
c407cd00	91	ret += scnprintf(buf + ret, PAGE_SIZE - ret,
7b4e08a7 MB	92	"TxClk output from %s",
	93	audmux_port_string((ptcr >> 22) & 0x7));
	94	else
c407cd00	95	ret += scnprintf(buf + ret, PAGE_SIZE - ret,
7b4e08a7 MB	96	"TxClk input");
7b4e08a7 MB	97
c407cd00	98	ret += scnprintf(buf + ret, PAGE_SIZE - ret, "\n");
7b4e08a7	99
af4872fb	100	if (ptcr & IMX_AUDMUX_V2_PTCR_SYN) {
c407cd00	101	ret += scnprintf(buf + ret, PAGE_SIZE - ret,
7b4e08a7 MB	102	"Port is symmetric");
7b4e08a7 MB	103	} else {
af4872fb	104	if (ptcr & IMX_AUDMUX_V2_PTCR_RFSDIR)
c407cd00	105	ret += scnprintf(buf + ret, PAGE_SIZE - ret,
7b4e08a7 MB	106	"RxFS output from %s, ",
	107	audmux_port_string((ptcr >> 17) & 0x7));
	108	else
c407cd00	109	ret += scnprintf(buf + ret, PAGE_SIZE - ret,
7b4e08a7 MB	110	"RxFS input, ");
7b4e08a7 MB	111
af4872fb	112	if (ptcr & IMX_AUDMUX_V2_PTCR_RCLKDIR)
c407cd00	113	ret += scnprintf(buf + ret, PAGE_SIZE - ret,
7b4e08a7 MB	114	"RxClk output from %s",
	115	audmux_port_string((ptcr >> 12) & 0x7));
	116	else
c407cd00	117	ret += scnprintf(buf + ret, PAGE_SIZE - ret,
7b4e08a7 MB	118	"RxClk input");
	119	}
	120
c407cd00	121	ret += scnprintf(buf + ret, PAGE_SIZE - ret,
7b4e08a7 MB	122	"\nData received from %s\n",
	123	audmux_port_string((pdcr >> 13) & 0x7));
	124
	125	ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
	126
	127	kfree(buf);
	128
	129	return ret;
	130	}
	131
	132	static const struct file_operations audmux_debugfs_fops = {
234e3405	133	.open = simple_open,
7b4e08a7	134	.read = audmux_read_file,
6038f373	135	.llseek = default_llseek,
7b4e08a7 MB	136	};
7b4e08a7 MB	137
b8909783	138	static void audmux_debugfs_init(void)
7b4e08a7	139	{
e5f89768	140	uintptr_t i;
7b4e08a7 MB	141	char buf[20];
	142
	143	audmux_debugfs_root = debugfs_create_dir("audmux", NULL);
	144	if (!audmux_debugfs_root) {
	145	pr_warning("Failed to create AUDMUX debugfs root\n");
	146	return;
	147	}
	148
409b78cc	149	for (i = 0; i < MX31_AUDMUX_PORT7_SSI_PINS_7 + 1; i++) {
e5f89768	150	snprintf(buf, sizeof(buf), "ssi%lu", i);
7b4e08a7 MB	151	if (!debugfs_create_file(buf, 0444, audmux_debugfs_root,
7b4e08a7 MB	152	(void *)i, &audmux_debugfs_fops))
e5f89768	153	pr_warning("Failed to create AUDMUX port %lu debugfs file\n",
7b4e08a7 MB	154	i);
	155	}
	156	}
3bc34a61	157
a0a3d518	158	static void audmux_debugfs_remove(void)
3bc34a61 RZ	159	{
	160	debugfs_remove_recursive(audmux_debugfs_root);
	161	}
7b4e08a7 MB	162	#else
	163	static inline void audmux_debugfs_init(void)
	164	{
	165	}
3bc34a61 RZ	166
	167	static inline void audmux_debugfs_remove(void)
	168	{
	169	}
7b4e08a7 MB	170	#endif
7b4e08a7 MB	171
a10807ae	172	static enum imx_audmux_type {
3bc34a61 RZ	173	IMX21_AUDMUX,
	174	IMX31_AUDMUX,
	175	} audmux_type;
	176
e51cebf7	177	static const struct platform_device_id imx_audmux_ids[] = {
3bc34a61 RZ	178	{
	179	.name = "imx21-audmux",
	180	.driver_data = IMX21_AUDMUX,
	181	}, {
	182	.name = "imx31-audmux",
	183	.driver_data = IMX31_AUDMUX,
	184	}, {
	185	/* sentinel */
	186	}
	187	};
	188	MODULE_DEVICE_TABLE(platform, imx_audmux_ids);
	189
9d5ef266 RZ	190	static const struct of_device_id imx_audmux_dt_ids[] = {
	191	{ .compatible = "fsl,imx21-audmux", .data = &imx_audmux_ids[0], },
	192	{ .compatible = "fsl,imx31-audmux", .data = &imx_audmux_ids[1], },
	193	{ /* sentinel */ }
	194	};
	195	MODULE_DEVICE_TABLE(of, imx_audmux_dt_ids);
	196
2405fc97 SG	197	static const uint8_t port_mapping[] = {
	198	0x0, 0x4, 0x8, 0x10, 0x14, 0x1c,
	199	};
	200
af4872fb	201	int imx_audmux_v1_configure_port(unsigned int port, unsigned int pcr)
2405fc97	202	{
3bc34a61 RZ	203	if (audmux_type != IMX21_AUDMUX)
	204	return -EINVAL;
	205
2405fc97 SG	206	if (!audmux_base)
	207	return -ENOSYS;
	208
	209	if (port >= ARRAY_SIZE(port_mapping))
	210	return -EINVAL;
	211
	212	writel(pcr, audmux_base + port_mapping[port]);
	213
	214	return 0;
	215	}
af4872fb	216	EXPORT_SYMBOL_GPL(imx_audmux_v1_configure_port);
2405fc97	217
af4872fb	218	int imx_audmux_v2_configure_port(unsigned int port, unsigned int ptcr,
9eedbdf1 SH	219	unsigned int pdcr)
9eedbdf1 SH	220	{
72192366 FE	221	int ret;
72192366 FE	222
3bc34a61 RZ	223	if (audmux_type != IMX31_AUDMUX)
	224	return -EINVAL;
	225
9eedbdf1 SH	226	if (!audmux_base)
	227	return -ENOSYS;
	228
72192366 FE	229	if (audmux_clk) {
	230	ret = clk_prepare_enable(audmux_clk);
	231	if (ret)
	232	return ret;
	233	}
9eedbdf1	234
af4872fb SG	235	writel(ptcr, audmux_base + IMX_AUDMUX_V2_PTCR(port));
af4872fb SG	236	writel(pdcr, audmux_base + IMX_AUDMUX_V2_PDCR(port));
9eedbdf1 SH	237
9eedbdf1 SH	238	if (audmux_clk)
bac59328	239	clk_disable_unprepare(audmux_clk);
9eedbdf1 SH	240
	241	return 0;
	242	}
af4872fb	243	EXPORT_SYMBOL_GPL(imx_audmux_v2_configure_port);
9eedbdf1	244
8548a464 MP	245	static int imx_audmux_parse_dt_defaults(struct platform_device *pdev,
	246	struct device_node *of_node)
	247	{
	248	struct device_node *child;
	249
	250	for_each_available_child_of_node(of_node, child) {
	251	unsigned int port;
	252	unsigned int ptcr = 0;
	253	unsigned int pdcr = 0;
	254	unsigned int pcr = 0;
	255	unsigned int val;
	256	int ret;
	257	int i = 0;
	258
	259	ret = of_property_read_u32(child, "fsl,audmux-port", &port);
	260	if (ret) {
06d15a2e RH	261	dev_warn(&pdev->dev, "Failed to get fsl,audmux-port of child node \"%pOF\"\n",
06d15a2e RH	262	child);
8548a464 MP	263	continue;
	264	}
	265	if (!of_property_read_bool(child, "fsl,port-config")) {
06d15a2e RH	266	dev_warn(&pdev->dev, "child node \"%pOF\" does not have property fsl,port-config\n",
06d15a2e RH	267	child);
8548a464 MP	268	continue;
	269	}
	270
	271	for (i = 0; (ret = of_property_read_u32_index(child,
9c0aeaa3	272	"fsl,port-config", i, &val)) == 0;
8548a464 MP	273	++i) {
	274	if (audmux_type == IMX31_AUDMUX) {
	275	if (i % 2)
	276	pdcr \|= val;
	277	else
	278	ptcr \|= val;
	279	} else {
	280	pcr \|= val;
	281	}
	282	}
	283
9c0aeaa3	284	if (ret != -EOVERFLOW) {
06d15a2e RH	285	dev_err(&pdev->dev, "Failed to read u32 at index %d of child %pOF\n",
06d15a2e RH	286	i, child);
8548a464 MP	287	continue;
	288	}
	289
	290	if (audmux_type == IMX31_AUDMUX) {
	291	if (i % 2) {
06d15a2e RH	292	dev_err(&pdev->dev, "One pdcr value is missing in child node %pOF\n",
06d15a2e RH	293	child);
8548a464 MP	294	continue;
	295	}
	296	imx_audmux_v2_configure_port(port, ptcr, pdcr);
	297	} else {
	298	imx_audmux_v1_configure_port(port, pcr);
	299	}
	300	}
	301
	302	return 0;
	303	}
	304
a0a3d518	305	static int imx_audmux_probe(struct platform_device *pdev)
9eedbdf1	306	{
3bc34a61	307	struct resource *res;
9d5ef266 RZ	308	const struct of_device_id *of_id =
9d5ef266 RZ	309	of_match_device(imx_audmux_dt_ids, &pdev->dev);
3bc34a61 RZ	310
3bc34a61 RZ	311	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
b25b5aa0 TR	312	audmux_base = devm_ioremap_resource(&pdev->dev, res);
	313	if (IS_ERR(audmux_base))
	314	return PTR_ERR(audmux_base);
3bc34a61	315
127c5cad	316	audmux_clk = devm_clk_get(&pdev->dev, "audmux");
3bc34a61 RZ	317	if (IS_ERR(audmux_clk)) {
	318	dev_dbg(&pdev->dev, "cannot get clock: %ld\n",
	319	PTR_ERR(audmux_clk));
	320	audmux_clk = NULL;
8402ed30	321	}
56c6b872	322
9d5ef266 RZ	323	if (of_id)
9d5ef266 RZ	324	pdev->id_entry = of_id->data;
3bc34a61 RZ	325	audmux_type = pdev->id_entry->driver_data;
3bc34a61 RZ	326	if (audmux_type == IMX31_AUDMUX)
2405fc97	327	audmux_debugfs_init();
7b4e08a7	328
bae35992 FE	329	if (of_id)
bae35992 FE	330	imx_audmux_parse_dt_defaults(pdev, pdev->dev.of_node);
8548a464	331
9eedbdf1 SH	332	return 0;
	333	}
	334
a0a3d518	335	static int imx_audmux_remove(struct platform_device *pdev)
3bc34a61 RZ	336	{
	337	if (audmux_type == IMX31_AUDMUX)
	338	audmux_debugfs_remove();
3bc34a61 RZ	339
	340	return 0;
	341	}
	342
	343	static struct platform_driver imx_audmux_driver = {
	344	.probe = imx_audmux_probe,
a0a3d518	345	.remove = imx_audmux_remove,
3bc34a61 RZ	346	.id_table = imx_audmux_ids,
	347	.driver = {
	348	.name = DRIVER_NAME,
9d5ef266	349	.of_match_table = imx_audmux_dt_ids,
3bc34a61 RZ	350	}
	351	};
	352
	353	static int __init imx_audmux_init(void)
	354	{
	355	return platform_driver_register(&imx_audmux_driver);
	356	}
	357	subsys_initcall(imx_audmux_init);
	358
	359	static void __exit imx_audmux_exit(void)
	360	{
	361	platform_driver_unregister(&imx_audmux_driver);
	362	}
	363	module_exit(imx_audmux_exit);
	364
	365	MODULE_DESCRIPTION("Freescale i.MX AUDMUX driver");
	366	MODULE_AUTHOR("Sascha Hauer <s.hauer@pengutronix.de>");
	367	MODULE_LICENSE("GPL v2");
	368	MODULE_ALIAS("platform:" DRIVER_NAME);