]>
Commit | Line | Data |
---|---|---|
9eedbdf1 SH |
1 | /* |
2 | * Copyright 2009 Pengutronix, Sascha Hauer <s.hauer@pengutronix.de> | |
3 | * | |
4 | * Initial development of this code was funded by | |
5 | * Phytec Messtechnik GmbH, http://www.phytec.de | |
6 | * | |
7 | * This program is free software; you can redistribute it and/or modify | |
8 | * it under the terms of the GNU General Public License as published by | |
9 | * the Free Software Foundation; either version 2 of the License, or | |
10 | * (at your option) any later version. | |
11 | * | |
12 | * This program is distributed in the hope that it will be useful, | |
13 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
15 | * GNU General Public License for more details. | |
16 | * | |
17 | * You should have received a copy of the GNU General Public License | |
18 | * along with this program; if not, write to the Free Software | |
19 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | |
20 | */ | |
21 | ||
22 | #include <linux/module.h> | |
23 | #include <linux/err.h> | |
24 | #include <linux/io.h> | |
25 | #include <linux/clk.h> | |
26 | #include <mach/audmux.h> | |
27 | #include <mach/hardware.h> | |
28 | ||
29 | static struct clk *audmux_clk; | |
30 | static void __iomem *audmux_base; | |
31 | ||
32 | #define MXC_AUDMUX_V2_PTCR(x) ((x) * 8) | |
33 | #define MXC_AUDMUX_V2_PDCR(x) ((x) * 8 + 4) | |
34 | ||
35 | int mxc_audmux_v2_configure_port(unsigned int port, unsigned int ptcr, | |
36 | unsigned int pdcr) | |
37 | { | |
38 | if (!audmux_base) | |
39 | return -ENOSYS; | |
40 | ||
41 | if (audmux_clk) | |
42 | clk_enable(audmux_clk); | |
43 | ||
44 | writel(ptcr, audmux_base + MXC_AUDMUX_V2_PTCR(port)); | |
45 | writel(pdcr, audmux_base + MXC_AUDMUX_V2_PDCR(port)); | |
46 | ||
47 | if (audmux_clk) | |
48 | clk_disable(audmux_clk); | |
49 | ||
50 | return 0; | |
51 | } | |
52 | EXPORT_SYMBOL_GPL(mxc_audmux_v2_configure_port); | |
53 | ||
54 | static int mxc_audmux_v2_init(void) | |
55 | { | |
56 | int ret; | |
57 | ||
58 | if (cpu_is_mx35()) { | |
59 | audmux_clk = clk_get(NULL, "audmux"); | |
60 | if (IS_ERR(audmux_clk)) { | |
61 | ret = PTR_ERR(audmux_clk); | |
62 | printk(KERN_ERR "%s: cannot get clock: %d\n", __func__, | |
63 | ret); | |
64 | return ret; | |
65 | } | |
66 | } | |
67 | ||
68 | if (cpu_is_mx31() || cpu_is_mx35()) | |
69 | audmux_base = IO_ADDRESS(AUDMUX_BASE_ADDR); | |
70 | ||
71 | return 0; | |
72 | } | |
73 | ||
74 | postcore_initcall(mxc_audmux_v2_init); |