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/imx-common/iomux-v3.h>
  15
  16 static void *base = (void *)IOMUXC_BASE_ADDR;
  17
  18 /*
  19  * configures a single pad in the iomuxer
  20  */
  21 void imx_iomux_v3_setup_pad(iomux_v3_cfg_t pad)
  22 {
  23         u32 mux_ctrl_ofs = (pad & MUX_CTRL_OFS_MASK) >> MUX_CTRL_OFS_SHIFT;
  24         u32 mux_mode = (pad & MUX_MODE_MASK) >> MUX_MODE_SHIFT;
  25         u32 sel_input_ofs =
  26                 (pad & MUX_SEL_INPUT_OFS_MASK) >> MUX_SEL_INPUT_OFS_SHIFT;
  27         u32 sel_input =
  28                 (pad & MUX_SEL_INPUT_MASK) >> MUX_SEL_INPUT_SHIFT;
  29         u32 pad_ctrl_ofs =
  30                 (pad & MUX_PAD_CTRL_OFS_MASK) >> MUX_PAD_CTRL_OFS_SHIFT;
  31         u32 pad_ctrl = (pad & MUX_PAD_CTRL_MASK) >> MUX_PAD_CTRL_SHIFT;
  32
  33         if (mux_ctrl_ofs)
  34                 __raw_writel(mux_mode, base + mux_ctrl_ofs);
  35
  36         if (sel_input_ofs)
  37                 __raw_writel(sel_input, base + sel_input_ofs);
  38
  39 #ifdef CONFIG_IOMUX_SHARE_CONF_REG
  40         if (pad & PAD_CTRL_VALID)
  41                 __raw_writel((mux_mode << PAD_MUX_MODE_SHIFT) | pad_ctrl,
  42                         base + pad_ctrl_ofs);
  43 #else
  44         if ((pad & PAD_CTRL_VALID) && pad_ctrl_ofs)
  45                 __raw_writel(pad_ctrl, base + pad_ctrl_ofs);
  46 #endif
  47 }
  48
  49 void imx_iomux_v3_setup_multiple_pads(iomux_v3_cfg_t const *pad_list,
  50                                       unsigned count)
  51 {
  52         iomux_v3_cfg_t const *p = pad_list;
  53         int i;
  54
  55         for (i = 0; i < count; i++) {
  56 #ifdef DEBUG
  57                 u32 mux_ctrl_ofs = (*p & MUX_CTRL_OFS_MASK) >> MUX_CTRL_OFS_SHIFT;
  58                 u32 mux_mode = (*p & MUX_MODE_MASK) >> MUX_MODE_SHIFT;
  59                 u32 sel_input_ofs =
  60                         (*p & MUX_SEL_INPUT_OFS_MASK) >> MUX_SEL_INPUT_OFS_SHIFT;
  61                 u32 sel_input =
  62                         (*p & MUX_SEL_INPUT_MASK) >> MUX_SEL_INPUT_SHIFT;
  63                 u32 pad_ctrl_ofs =
  64                         (*p & MUX_PAD_CTRL_OFS_MASK) >> MUX_PAD_CTRL_OFS_SHIFT;
  65                 u32 pad_ctrl = (*p & MUX_PAD_CTRL_MASK) >> MUX_PAD_CTRL_SHIFT;
  66
  67                 printf("PAD[%2d]=%016llx mux[%03x]=%02x pad[%03x]=%05x%c inp[%03x]=%d\n",
  68                         i, *p, mux_ctrl_ofs, mux_mode, pad_ctrl_ofs, pad_ctrl,
  69                         *p & PAD_CTRL_VALID ? ' ' : '!', sel_input_ofs, sel_input);
  70 #endif
  71                 imx_iomux_v3_setup_pad(*p++);
  72         }
  73 }