| Sascha Hauer | 9eedbdf | 2009-10-29 17:12:39 +0100 | [diff] [blame^] | 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); |