[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;
	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 = 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 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 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", 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 %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();

	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,
		.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;
1b3ed70a	69	char *buf;
e5f89768	70	uintptr_t port = (uintptr_t)file->private_data;
7b4e08a7 MB	71	u32 pdcr, ptcr;
7b4e08a7 MB	72
72192366 FE	73	if (audmux_clk) {
	74	ret = clk_prepare_enable(audmux_clk);
	75	if (ret)
	76	return ret;
	77	}
7b4e08a7	78
af4872fb SG	79	ptcr = readl(audmux_base + IMX_AUDMUX_V2_PTCR(port));
af4872fb SG	80	pdcr = readl(audmux_base + IMX_AUDMUX_V2_PDCR(port));
7b4e08a7 MB	81
7b4e08a7 MB	82	if (audmux_clk)
bac59328	83	clk_disable_unprepare(audmux_clk);
7b4e08a7	84
1b3ed70a FP	85	buf = kmalloc(PAGE_SIZE, GFP_KERNEL);
	86	if (!buf)
	87	return -ENOMEM;
	88
7b4e08a7 MB	89	ret = snprintf(buf, PAGE_SIZE, "PDCR: %08x\nPTCR: %08x\n",
	90	pdcr, ptcr);
	91
af4872fb	92	if (ptcr & IMX_AUDMUX_V2_PTCR_TFSDIR)
7b4e08a7 MB	93	ret += snprintf(buf + ret, PAGE_SIZE - ret,
	94	"TxFS output from %s, ",
	95	audmux_port_string((ptcr >> 27) & 0x7));
	96	else
	97	ret += snprintf(buf + ret, PAGE_SIZE - ret,
	98	"TxFS input, ");
	99
af4872fb	100	if (ptcr & IMX_AUDMUX_V2_PTCR_TCLKDIR)
7b4e08a7 MB	101	ret += snprintf(buf + ret, PAGE_SIZE - ret,
	102	"TxClk output from %s",
	103	audmux_port_string((ptcr >> 22) & 0x7));
	104	else
	105	ret += snprintf(buf + ret, PAGE_SIZE - ret,
	106	"TxClk input");
	107
	108	ret += snprintf(buf + ret, PAGE_SIZE - ret, "\n");
	109
af4872fb	110	if (ptcr & IMX_AUDMUX_V2_PTCR_SYN) {
7b4e08a7 MB	111	ret += snprintf(buf + ret, PAGE_SIZE - ret,
	112	"Port is symmetric");
	113	} else {
af4872fb	114	if (ptcr & IMX_AUDMUX_V2_PTCR_RFSDIR)
7b4e08a7 MB	115	ret += snprintf(buf + ret, PAGE_SIZE - ret,
	116	"RxFS output from %s, ",
	117	audmux_port_string((ptcr >> 17) & 0x7));
	118	else
	119	ret += snprintf(buf + ret, PAGE_SIZE - ret,
	120	"RxFS input, ");
	121
af4872fb	122	if (ptcr & IMX_AUDMUX_V2_PTCR_RCLKDIR)
7b4e08a7 MB	123	ret += snprintf(buf + ret, PAGE_SIZE - ret,
	124	"RxClk output from %s",
	125	audmux_port_string((ptcr >> 12) & 0x7));
	126	else
	127	ret += snprintf(buf + ret, PAGE_SIZE - ret,
	128	"RxClk input");
	129	}
	130
	131	ret += snprintf(buf + ret, PAGE_SIZE - ret,
	132	"\nData received from %s\n",
	133	audmux_port_string((pdcr >> 13) & 0x7));
	134
	135	ret = simple_read_from_buffer(user_buf, count, ppos, buf, ret);
	136
	137	kfree(buf);
	138
	139	return ret;
	140	}
	141
	142	static const struct file_operations audmux_debugfs_fops = {
234e3405	143	.open = simple_open,
7b4e08a7	144	.read = audmux_read_file,
6038f373	145	.llseek = default_llseek,
7b4e08a7 MB	146	};
7b4e08a7 MB	147
b8909783	148	static void audmux_debugfs_init(void)
7b4e08a7	149	{
e5f89768	150	uintptr_t i;
7b4e08a7 MB	151	char buf[20];
	152
	153	audmux_debugfs_root = debugfs_create_dir("audmux", NULL);
	154	if (!audmux_debugfs_root) {
	155	pr_warning("Failed to create AUDMUX debugfs root\n");
	156	return;
	157	}
	158
409b78cc	159	for (i = 0; i < MX31_AUDMUX_PORT7_SSI_PINS_7 + 1; i++) {
e5f89768	160	snprintf(buf, sizeof(buf), "ssi%lu", i);
7b4e08a7 MB	161	if (!debugfs_create_file(buf, 0444, audmux_debugfs_root,
7b4e08a7 MB	162	(void *)i, &audmux_debugfs_fops))
e5f89768	163	pr_warning("Failed to create AUDMUX port %lu debugfs file\n",
7b4e08a7 MB	164	i);
	165	}
	166	}
3bc34a61	167
a0a3d518	168	static void audmux_debugfs_remove(void)
3bc34a61 RZ	169	{
	170	debugfs_remove_recursive(audmux_debugfs_root);
	171	}
7b4e08a7 MB	172	#else
	173	static inline void audmux_debugfs_init(void)
	174	{
	175	}
3bc34a61 RZ	176
	177	static inline void audmux_debugfs_remove(void)
	178	{
	179	}
7b4e08a7 MB	180	#endif
7b4e08a7 MB	181
a10807ae	182	static enum imx_audmux_type {
3bc34a61 RZ	183	IMX21_AUDMUX,
	184	IMX31_AUDMUX,
	185	} audmux_type;
	186
	187	static struct platform_device_id imx_audmux_ids[] = {
	188	{
	189	.name = "imx21-audmux",
	190	.driver_data = IMX21_AUDMUX,
	191	}, {
	192	.name = "imx31-audmux",
	193	.driver_data = IMX31_AUDMUX,
	194	}, {
	195	/* sentinel */
	196	}
	197	};
	198	MODULE_DEVICE_TABLE(platform, imx_audmux_ids);
	199
9d5ef266 RZ	200	static const struct of_device_id imx_audmux_dt_ids[] = {
	201	{ .compatible = "fsl,imx21-audmux", .data = &imx_audmux_ids[0], },
	202	{ .compatible = "fsl,imx31-audmux", .data = &imx_audmux_ids[1], },
	203	{ /* sentinel */ }
	204	};
	205	MODULE_DEVICE_TABLE(of, imx_audmux_dt_ids);
	206
2405fc97 SG	207	static const uint8_t port_mapping[] = {
	208	0x0, 0x4, 0x8, 0x10, 0x14, 0x1c,
	209	};
	210
af4872fb	211	int imx_audmux_v1_configure_port(unsigned int port, unsigned int pcr)
2405fc97	212	{
3bc34a61 RZ	213	if (audmux_type != IMX21_AUDMUX)
	214	return -EINVAL;
	215
2405fc97 SG	216	if (!audmux_base)
	217	return -ENOSYS;
	218
	219	if (port >= ARRAY_SIZE(port_mapping))
	220	return -EINVAL;
	221
	222	writel(pcr, audmux_base + port_mapping[port]);
	223
	224	return 0;
	225	}
af4872fb	226	EXPORT_SYMBOL_GPL(imx_audmux_v1_configure_port);
2405fc97	227
af4872fb	228	int imx_audmux_v2_configure_port(unsigned int port, unsigned int ptcr,
9eedbdf1 SH	229	unsigned int pdcr)
9eedbdf1 SH	230	{
72192366 FE	231	int ret;
72192366 FE	232
3bc34a61 RZ	233	if (audmux_type != IMX31_AUDMUX)
	234	return -EINVAL;
	235
9eedbdf1 SH	236	if (!audmux_base)
	237	return -ENOSYS;
	238
72192366 FE	239	if (audmux_clk) {
	240	ret = clk_prepare_enable(audmux_clk);
	241	if (ret)
	242	return ret;
	243	}
9eedbdf1	244
af4872fb SG	245	writel(ptcr, audmux_base + IMX_AUDMUX_V2_PTCR(port));
af4872fb SG	246	writel(pdcr, audmux_base + IMX_AUDMUX_V2_PDCR(port));
9eedbdf1 SH	247
9eedbdf1 SH	248	if (audmux_clk)
bac59328	249	clk_disable_unprepare(audmux_clk);
9eedbdf1 SH	250
	251	return 0;
	252	}
af4872fb	253	EXPORT_SYMBOL_GPL(imx_audmux_v2_configure_port);
9eedbdf1	254
8548a464 MP	255	static int imx_audmux_parse_dt_defaults(struct platform_device *pdev,
	256	struct device_node *of_node)
	257	{
	258	struct device_node *child;
	259
	260	for_each_available_child_of_node(of_node, child) {
	261	unsigned int port;
	262	unsigned int ptcr = 0;
	263	unsigned int pdcr = 0;
	264	unsigned int pcr = 0;
	265	unsigned int val;
	266	int ret;
	267	int i = 0;
	268
	269	ret = of_property_read_u32(child, "fsl,audmux-port", &port);
	270	if (ret) {
	271	dev_warn(&pdev->dev, "Failed to get fsl,audmux-port of child node \"%s\"\n",
	272	child->full_name);
	273	continue;
	274	}
	275	if (!of_property_read_bool(child, "fsl,port-config")) {
	276	dev_warn(&pdev->dev, "child node \"%s\" does not have property fsl,port-config\n",
	277	child->full_name);
	278	continue;
	279	}
	280
	281	for (i = 0; (ret = of_property_read_u32_index(child,
9c0aeaa3	282	"fsl,port-config", i, &val)) == 0;
8548a464 MP	283	++i) {
	284	if (audmux_type == IMX31_AUDMUX) {
	285	if (i % 2)
	286	pdcr \|= val;
	287	else
	288	ptcr \|= val;
	289	} else {
	290	pcr \|= val;
	291	}
	292	}
	293
9c0aeaa3	294	if (ret != -EOVERFLOW) {
8548a464 MP	295	dev_err(&pdev->dev, "Failed to read u32 at index %d of child %s\n",
	296	i, child->full_name);
	297	continue;
	298	}
	299
	300	if (audmux_type == IMX31_AUDMUX) {
	301	if (i % 2) {
	302	dev_err(&pdev->dev, "One pdcr value is missing in child node %s\n",
	303	child->full_name);
	304	continue;
	305	}
	306	imx_audmux_v2_configure_port(port, ptcr, pdcr);
	307	} else {
	308	imx_audmux_v1_configure_port(port, pcr);
	309	}
	310	}
	311
	312	return 0;
	313	}
	314
a0a3d518	315	static int imx_audmux_probe(struct platform_device *pdev)
9eedbdf1	316	{
3bc34a61	317	struct resource *res;
9d5ef266 RZ	318	const struct of_device_id *of_id =
9d5ef266 RZ	319	of_match_device(imx_audmux_dt_ids, &pdev->dev);
3bc34a61 RZ	320
3bc34a61 RZ	321	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
b25b5aa0 TR	322	audmux_base = devm_ioremap_resource(&pdev->dev, res);
	323	if (IS_ERR(audmux_base))
	324	return PTR_ERR(audmux_base);
3bc34a61	325
127c5cad	326	audmux_clk = devm_clk_get(&pdev->dev, "audmux");
3bc34a61 RZ	327	if (IS_ERR(audmux_clk)) {
	328	dev_dbg(&pdev->dev, "cannot get clock: %ld\n",
	329	PTR_ERR(audmux_clk));
	330	audmux_clk = NULL;
8402ed30	331	}
56c6b872	332
9d5ef266 RZ	333	if (of_id)
9d5ef266 RZ	334	pdev->id_entry = of_id->data;
3bc34a61 RZ	335	audmux_type = pdev->id_entry->driver_data;
3bc34a61 RZ	336	if (audmux_type == IMX31_AUDMUX)
2405fc97	337	audmux_debugfs_init();
7b4e08a7	338
bae35992 FE	339	if (of_id)
bae35992 FE	340	imx_audmux_parse_dt_defaults(pdev, pdev->dev.of_node);
8548a464	341
9eedbdf1 SH	342	return 0;
	343	}
	344
a0a3d518	345	static int imx_audmux_remove(struct platform_device *pdev)
3bc34a61 RZ	346	{
	347	if (audmux_type == IMX31_AUDMUX)
	348	audmux_debugfs_remove();
3bc34a61 RZ	349
	350	return 0;
	351	}
	352
	353	static struct platform_driver imx_audmux_driver = {
	354	.probe = imx_audmux_probe,
a0a3d518	355	.remove = imx_audmux_remove,
3bc34a61 RZ	356	.id_table = imx_audmux_ids,
	357	.driver = {
	358	.name = DRIVER_NAME,
	359	.owner = THIS_MODULE,
9d5ef266	360	.of_match_table = imx_audmux_dt_ids,
3bc34a61 RZ	361	}
	362	};
	363
	364	static int __init imx_audmux_init(void)
	365	{
	366	return platform_driver_register(&imx_audmux_driver);
	367	}
	368	subsys_initcall(imx_audmux_init);
	369
	370	static void __exit imx_audmux_exit(void)
	371	{
	372	platform_driver_unregister(&imx_audmux_driver);
	373	}
	374	module_exit(imx_audmux_exit);
	375
	376	MODULE_DESCRIPTION("Freescale i.MX AUDMUX driver");
	377	MODULE_AUTHOR("Sascha Hauer <s.hauer@pengutronix.de>");
	378	MODULE_LICENSE("GPL v2");
	379	MODULE_ALIAS("platform:" DRIVER_NAME);