arch/arm/plat-mxc/audmux-v2.c

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