git.oblomov.eu Git - linux-2.6/blob - arch/arm/mach-davinci/mux.c

   1 /*
   2  * DaVinci pin multiplexing configurations
   3  *
   4  * Author: Vladimir Barinov, MontaVista Software, Inc. <source@mvista.com>
   5  *
   6  * 2007 (c) MontaVista Software, Inc. This file is licensed under
   7  * the terms of the GNU General Public License version 2. This program
   8  * is licensed "as is" without any warranty of any kind, whether express
   9  * or implied.
  10  */
  11 #include <linux/io.h>
  12 #include <linux/spinlock.h>
  13
  14 #include <mach/hardware.h>
  15
  16 #include <mach/mux.h>
  17
  18 /* System control register offsets */
  19 #define PINMUX0         0x00
  20 #define PINMUX1         0x04
  21
  22 static DEFINE_SPINLOCK(mux_lock);
  23
  24 void davinci_mux_peripheral(unsigned int mux, unsigned int enable)
  25 {
  26         void __iomem *base = IO_ADDRESS(DAVINCI_SYSTEM_MODULE_BASE);
  27         u32 pinmux, muxreg = PINMUX0;
  28
  29         if (mux >= DAVINCI_MUX_LEVEL2) {
  30                 muxreg = PINMUX1;
  31                 mux -= DAVINCI_MUX_LEVEL2;
  32         }
  33
  34         spin_lock(&mux_lock);
  35         pinmux = __raw_readl(base + muxreg);
  36         if (enable)
  37                 pinmux |= (1 << mux);
  38         else
  39                 pinmux &= ~(1 << mux);
  40         __raw_writel(pinmux, base + muxreg);
  41         spin_unlock(&mux_lock);
  42 }