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 #include <asm/arch/sys_proto.h>
  15 #include <asm/imx-common/iomux-v3.h>
  16
  17 static void *base = (void *)IOMUXC_BASE_ADDR;
  18
  19 /*
  20  * configures a single pad in the iomuxer
  21  */
  22 void imx_iomux_v3_setup_pad(iomux_v3_cfg_t pad)
  23 {
  24         u32 mux_ctrl_ofs = (pad & MUX_CTRL_OFS_MASK) >> MUX_CTRL_OFS_SHIFT;
  25         u32 mux_mode = (pad & MUX_MODE_MASK) >> MUX_MODE_SHIFT;
  26         u32 sel_input_ofs =
  27                 (pad & MUX_SEL_INPUT_OFS_MASK) >> MUX_SEL_INPUT_OFS_SHIFT;
  28         u32 sel_input =
  29                 (pad & MUX_SEL_INPUT_MASK) >> MUX_SEL_INPUT_SHIFT;
  30         u32 pad_ctrl_ofs =
  31                 (pad & MUX_PAD_CTRL_OFS_MASK) >> MUX_PAD_CTRL_OFS_SHIFT;
  32         u32 pad_ctrl = (pad & MUX_PAD_CTRL_MASK) >> MUX_PAD_CTRL_SHIFT;
  33
  34 #if defined CONFIG_MX6SL
  35         /* Check whether LVE bit needs to be set */
  36         if (pad_ctrl & PAD_CTL_LVE) {
  37                 pad_ctrl &= ~PAD_CTL_LVE;
  38                 pad_ctrl |= PAD_CTL_LVE_BIT;
  39         }
  40 #endif
  41
  42         if (mux_ctrl_ofs)
  43                 __raw_writel(mux_mode, base + mux_ctrl_ofs);
  44
  45         if (sel_input_ofs)
  46                 __raw_writel(sel_input, base + sel_input_ofs);
  47
  48 #ifdef CONFIG_IOMUX_SHARE_CONF_REG
  49         if (!(pad_ctrl & NO_PAD_CTRL))
  50                 __raw_writel((mux_mode << PAD_MUX_MODE_SHIFT) | pad_ctrl,
  51                         base + pad_ctrl_ofs);
  52 #else
  53         if (!(pad_ctrl & NO_PAD_CTRL) && pad_ctrl_ofs)
  54                 __raw_writel(pad_ctrl, base + pad_ctrl_ofs);
  55 #endif
  56 }
  57
  58 /* configures a list of pads within declared with IOMUX_PADS macro */
  59 void imx_iomux_v3_setup_multiple_pads(iomux_v3_cfg_t const *pad_list,
  60                                       unsigned count)
  61 {
  62         iomux_v3_cfg_t const *p = pad_list;
  63         int stride;
  64         int i;
  65
  66 #if defined(CONFIG_MX6QDL)
  67         stride = 2;
  68         if (!is_cpu_type(MXC_CPU_MX6Q) && !is_cpu_type(MXC_CPU_MX6D))
  69                 p += 1;
  70 #else
  71         stride = 1;
  72 #endif
  73         for (i = 0; i < count; i++) {
  74                 imx_iomux_v3_setup_pad(*p);
  75                 p += stride;
  76         }
  77 }