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 void __iomem *audmux_base; | |
30 | ||
4c8b581d SH |
31 | static unsigned char port_mapping[] = { |
32 | 0x0, 0x4, 0x8, 0x10, 0x14, 0x1c, | |
33 | }; | |
9eedbdf1 SH |
34 | |
35 | int mxc_audmux_v1_configure_port(unsigned int port, unsigned int pcr) | |
36 | { | |
37 | if (!audmux_base) { | |
38 | printk("%s: not configured\n", __func__); | |
39 | return -ENOSYS; | |
40 | } | |
41 | ||
4c8b581d SH |
42 | if (port >= ARRAY_SIZE(port_mapping)) |
43 | return -EINVAL; | |
44 | ||
45 | writel(pcr, audmux_base + port_mapping[port]); | |
9eedbdf1 SH |
46 | |
47 | return 0; | |
48 | } | |
49 | EXPORT_SYMBOL_GPL(mxc_audmux_v1_configure_port); | |
50 | ||
51 | static int mxc_audmux_v1_init(void) | |
52 | { | |
51918075 UKK |
53 | #ifdef CONFIG_MACH_MX21 |
54 | if (cpu_is_mx21()) | |
55 | audmux_base = MX21_IO_ADDRESS(MX21_AUDMUX_BASE_ADDR); | |
56 | else | |
57 | #endif | |
58 | #ifdef CONFIG_MACH_MX27 | |
59 | if (cpu_is_mx27()) | |
60 | audmux_base = MX27_IO_ADDRESS(MX27_AUDMUX_BASE_ADDR); | |
61 | else | |
62 | #endif | |
63 | (void)0; | |
64 | ||
9eedbdf1 SH |
65 | return 0; |
66 | } | |
67 | ||
68 | postcore_initcall(mxc_audmux_v1_init); |