arch/arm/mach-imx/anatop.c

   1 /*
   2  * Copyright (C) 2013 Freescale Semiconductor, Inc.
   3  *
   4  * The code contained herein is licensed under the GNU General Public
   5  * License. You may obtain a copy of the GNU General Public License
   6  * Version 2 or later at the following locations:
   7  *
   8  * http://www.opensource.org/licenses/gpl-license.html
   9  * http://www.gnu.org/copyleft/gpl.html
  10  */
  11
  12 #include <linux/err.h>
  13 #include <linux/io.h>
  14 #include <linux/of.h>
  15 #include <linux/of_address.h>
  16 #include <linux/mfd/syscon.h>
  17 #include <linux/regmap.h>
  18 #include "common.h"
  19
  20 #define REG_SET         0x4
  21 #define REG_CLR         0x8
  22
  23 #define ANADIG_REG_2P5          0x130
  24 #define ANADIG_REG_CORE         0x140
  25 #define ANADIG_ANA_MISC0        0x150
  26 #define ANADIG_USB1_CHRG_DETECT 0x1b0
  27 #define ANADIG_USB2_CHRG_DETECT 0x210
  28 #define ANADIG_DIGPROG          0x260
  29
  30 #define BM_ANADIG_REG_2P5_ENABLE_WEAK_LINREG    0x40000
  31 #define BM_ANADIG_REG_CORE_FET_ODRIVE           0x20000000
  32 #define BM_ANADIG_ANA_MISC0_STOP_MODE_CONFIG    0x1000
  33 #define BM_ANADIG_USB_CHRG_DETECT_CHK_CHRG_B    0x80000
  34 #define BM_ANADIG_USB_CHRG_DETECT_EN_B          0x100000
  35
  36 static struct regmap *anatop;
  37
  38 static void imx_anatop_enable_weak2p5(bool enable)
  39 {
  40         u32 reg, val;
  41
  42         regmap_read(anatop, ANADIG_ANA_MISC0, &val);
  43
  44         /* can only be enabled when stop_mode_config is clear. */
  45         reg = ANADIG_REG_2P5;
  46         reg += (enable && (val & BM_ANADIG_ANA_MISC0_STOP_MODE_CONFIG) == 0) ?
  47                 REG_SET : REG_CLR;
  48         regmap_write(anatop, reg, BM_ANADIG_REG_2P5_ENABLE_WEAK_LINREG);
  49 }
  50
  51 static void imx_anatop_enable_fet_odrive(bool enable)
  52 {
  53         regmap_write(anatop, ANADIG_REG_CORE + (enable ? REG_SET : REG_CLR),
  54                 BM_ANADIG_REG_CORE_FET_ODRIVE);
  55 }
  56
  57 void imx_anatop_pre_suspend(void)
  58 {
  59         imx_anatop_enable_weak2p5(true);
  60         imx_anatop_enable_fet_odrive(true);
  61 }
  62
  63 void imx_anatop_post_resume(void)
  64 {
  65         imx_anatop_enable_fet_odrive(false);
  66         imx_anatop_enable_weak2p5(false);
  67 }
  68
  69 static void imx_anatop_usb_chrg_detect_disable(void)
  70 {
  71         regmap_write(anatop, ANADIG_USB1_CHRG_DETECT,
  72                 BM_ANADIG_USB_CHRG_DETECT_EN_B
  73                 | BM_ANADIG_USB_CHRG_DETECT_CHK_CHRG_B);
  74         regmap_write(anatop, ANADIG_USB2_CHRG_DETECT,
  75                 BM_ANADIG_USB_CHRG_DETECT_EN_B |
  76                 BM_ANADIG_USB_CHRG_DETECT_CHK_CHRG_B);
  77 }
  78
  79 u32 imx_anatop_get_digprog(void)
  80 {
  81         struct device_node *np;
  82         void __iomem *anatop_base;
  83         static u32 digprog;
  84
  85         if (digprog)
  86                 return digprog;
  87
  88         np = of_find_compatible_node(NULL, NULL, "fsl,imx6q-anatop");
  89         anatop_base = of_iomap(np, 0);
  90         WARN_ON(!anatop_base);
  91         digprog = readl_relaxed(anatop_base + ANADIG_DIGPROG);
  92
  93         return digprog;
  94 }
  95
  96 void __init imx_anatop_init(void)
  97 {
  98         anatop = syscon_regmap_lookup_by_compatible("fsl,imx6q-anatop");
  99         if (IS_ERR(anatop)) {
 100                 pr_err("%s: failed to find imx6q-anatop regmap!\n", __func__);
 101                 return;
 102         }
 103
 104         imx_anatop_usb_chrg_detect_disable();
 105 }