[mirror_ubuntu-artful-kernel.git] / sound / soc / fsl / imx-audmux.c

/*
 * 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
 *
 * 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 2 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.
 */

#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 = kmalloc(PAGE_SIZE, GFP_KERNEL);
	int port = (int)file->private_data;
	u32 pdcr, ptcr;

	if (!buf)
		return -ENOMEM;

	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);

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

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

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

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

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

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

	ret += snprintf(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 __init audmux_debugfs_init(void)
{
	int 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%d", i);
		if (!debugfs_create_file(buf, 0444, audmux_debugfs_root,
					 (void *)i, &audmux_debugfs_fops))
			pr_warning("Failed to create AUDMUX port %d 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 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 \"%s\"\n",
					child->full_name);
			continue;
		}
		if (!of_property_read_bool(child, "fsl,port-config")) {
			dev_warn(&pdev->dev, "child node \"%s\" does not have property fsl,port-config\n",
					child->full_name);
			continue;
		}

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

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

		if (audmux_type == IMX31_AUDMUX) {
			if (i % 2) {
				dev_err(&pdev->dev, "One pdcr value is missing in child node %s\n",
						child->full_name);
				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();

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