arch/arm/imx-common/iomux-v3.c

   1 /*
   2  * Based on the iomux-v3.c from Linux kernel:
   3  * Copyright (C) 2008 by Sascha Hauer <kernel@pengutronix.de>
   4  * Copyright (C) 2009 by Jan Weitzel Phytec Messtechnik GmbH,
   5  *                       <armlinux@phytec.de>
   6  *
   7  * Copyright (C) 2004-2011 Freescale Semiconductor, Inc.
   8  *
   9  * SPDX-License-Identifier:     GPL-2.0+
  10  */
  11 #include <common.h>
  12 #include <asm/io.h>
  13 #include <asm/arch/imx-regs.h>
  14 #if !defined(CONFIG_MX25) && !defined(CONFIG_VF610)
  15 #include <asm/arch/sys_proto.h>
  16 #endif
  17 #include <asm/imx-common/iomux-v3.h>
  18
  19 static void *base = (void *)IOMUXC_BASE_ADDR;
  20
  21 /*
  22  * configures a single pad in the iomuxer
  23  */
  24 void imx_iomux_v3_setup_pad(iomux_v3_cfg_t pad)
  25 {
  26         u32 mux_ctrl_ofs = (pad & MUX_CTRL_OFS_MASK) >> MUX_CTRL_OFS_SHIFT;
  27         u32 mux_mode = (pad & MUX_MODE_MASK) >> MUX_MODE_SHIFT;
  28         u32 sel_input_ofs =
  29                 (pad & MUX_SEL_INPUT_OFS_MASK) >> MUX_SEL_INPUT_OFS_SHIFT;
  30         u32 sel_input =
  31                 (pad & MUX_SEL_INPUT_MASK) >> MUX_SEL_INPUT_SHIFT;
  32         u32 pad_ctrl_ofs =
  33                 (pad & MUX_PAD_CTRL_OFS_MASK) >> MUX_PAD_CTRL_OFS_SHIFT;
  34         u32 pad_ctrl = (pad & MUX_PAD_CTRL_MASK) >> MUX_PAD_CTRL_SHIFT;
  35
  36 #if defined CONFIG_MX6SL
  37         /* Check whether LVE bit needs to be set */
  38         if (pad_ctrl & PAD_CTL_LVE) {
  39                 pad_ctrl &= ~PAD_CTL_LVE;
  40                 pad_ctrl |= PAD_CTL_LVE_BIT;
  41         }
  42 #endif
  43
  44         if (mux_ctrl_ofs)
  45                 __raw_writel(mux_mode, base + mux_ctrl_ofs);
  46
  47         if (sel_input_ofs)
  48                 __raw_writel(sel_input, base + sel_input_ofs);
  49
  50 #ifdef CONFIG_IOMUX_SHARE_CONF_REG
  51         if (!(pad_ctrl & NO_PAD_CTRL))
  52                 __raw_writel((mux_mode << PAD_MUX_MODE_SHIFT) | pad_ctrl,
  53                         base + pad_ctrl_ofs);
  54 #else
  55         if (!(pad_ctrl & NO_PAD_CTRL) && pad_ctrl_ofs)
  56                 __raw_writel(pad_ctrl, base + pad_ctrl_ofs);
  57 #endif
  58 }
  59
  60 /* configures a list of pads within declared with IOMUX_PADS macro */
  61 void imx_iomux_v3_setup_multiple_pads(iomux_v3_cfg_t const *pad_list,
  62                                       unsigned count)
  63 {
  64         iomux_v3_cfg_t const *p = pad_list;
  65         int stride;
  66         int i;
  67
  68 #if defined(CONFIG_MX6QDL)
  69         stride = 2;
  70         if (!is_cpu_type(MXC_CPU_MX6Q) && !is_cpu_type(MXC_CPU_MX6D))
  71                 p += 1;
  72 #else
  73         stride = 1;
  74 #endif
  75         for (i = 0; i < count; i++) {
  76                 imx_iomux_v3_setup_pad(*p);
  77                 p += stride;
  78         }
  79 }