Commit | Line | Data |
---|---|---|
e95dddb3 AH |
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 | ||
19 | #define REG_SET 0x4 | |
20 | #define REG_CLR 0x8 | |
21 | ||
22 | #define ANADIG_REG_CORE 0x140 | |
23 | #define ANADIG_USB1_CHRG_DETECT 0x1b0 | |
24 | #define ANADIG_USB2_CHRG_DETECT 0x210 | |
25 | #define ANADIG_DIGPROG 0x260 | |
26 | ||
27 | #define BM_ANADIG_REG_CORE_FET_ODRIVE 0x20000000 | |
28 | #define BM_ANADIG_USB_CHRG_DETECT_CHK_CHRG_B 0x80000 | |
29 | #define BM_ANADIG_USB_CHRG_DETECT_EN_B 0x100000 | |
30 | ||
31 | static struct regmap *anatop; | |
32 | ||
33 | static void imx_anatop_enable_fet_odrive(bool enable) | |
34 | { | |
35 | regmap_write(anatop, ANADIG_REG_CORE + (enable ? REG_SET : REG_CLR), | |
36 | BM_ANADIG_REG_CORE_FET_ODRIVE); | |
37 | } | |
38 | ||
39 | void imx_anatop_pre_suspend(void) | |
40 | { | |
41 | imx_anatop_enable_fet_odrive(true); | |
42 | } | |
43 | ||
44 | void imx_anatop_post_resume(void) | |
45 | { | |
46 | imx_anatop_enable_fet_odrive(false); | |
47 | } | |
48 | ||
49 | void imx_anatop_usb_chrg_detect_disable(void) | |
50 | { | |
51 | regmap_write(anatop, ANADIG_USB1_CHRG_DETECT, | |
52 | BM_ANADIG_USB_CHRG_DETECT_EN_B | |
53 | | BM_ANADIG_USB_CHRG_DETECT_CHK_CHRG_B); | |
54 | regmap_write(anatop, ANADIG_USB2_CHRG_DETECT, | |
55 | BM_ANADIG_USB_CHRG_DETECT_EN_B | | |
56 | BM_ANADIG_USB_CHRG_DETECT_CHK_CHRG_B); | |
57 | } | |
58 | ||
59 | u32 imx_anatop_get_digprog(void) | |
60 | { | |
61 | u32 val; | |
62 | ||
63 | regmap_read(anatop, ANADIG_DIGPROG, &val); | |
64 | return val; | |
65 | } | |
66 | ||
67 | void __init imx_anatop_init(void) | |
68 | { | |
69 | anatop = syscon_regmap_lookup_by_compatible("fsl,imx6q-anatop"); | |
70 | if (IS_ERR(anatop)) { | |
71 | pr_err("%s: failed to find imx6q-anatop regmap!\n", __func__); | |
72 | return; | |
73 | } | |
74 | } |