2 * Copyright (C) 2013 Freescale Semiconductor, Inc.
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:
8 * http://www.opensource.org/licenses/gpl-license.html
9 * http://www.gnu.org/copyleft/gpl.html
12 #include <linux/err.h>
15 #include <linux/of_address.h>
16 #include <linux/mfd/syscon.h>
17 #include <linux/regmap.h>
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
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
36 static struct regmap
*anatop
;
38 static void imx_anatop_enable_weak2p5(bool enable
)
42 regmap_read(anatop
, ANADIG_ANA_MISC0
, &val
);
44 /* can only be enabled when stop_mode_config is clear. */
46 reg
+= (enable
&& (val
& BM_ANADIG_ANA_MISC0_STOP_MODE_CONFIG
) == 0) ?
48 regmap_write(anatop
, reg
, BM_ANADIG_REG_2P5_ENABLE_WEAK_LINREG
);
51 static void imx_anatop_enable_fet_odrive(bool enable
)
53 regmap_write(anatop
, ANADIG_REG_CORE
+ (enable
? REG_SET
: REG_CLR
),
54 BM_ANADIG_REG_CORE_FET_ODRIVE
);
57 void imx_anatop_pre_suspend(void)
59 imx_anatop_enable_weak2p5(true);
60 imx_anatop_enable_fet_odrive(true);
63 void imx_anatop_post_resume(void)
65 imx_anatop_enable_fet_odrive(false);
66 imx_anatop_enable_weak2p5(false);
69 static void imx_anatop_usb_chrg_detect_disable(void)
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
);
79 u32
imx_anatop_get_digprog(void)
81 struct device_node
*np
;
82 void __iomem
*anatop_base
;
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
);
96 void __init
imx_anatop_init(void)
98 anatop
= syscon_regmap_lookup_by_compatible("fsl,imx6q-anatop");
100 pr_err("%s: failed to find imx6q-anatop regmap!\n", __func__
);
104 imx_anatop_usb_chrg_detect_disable();