1e95dddb3SAnson Huang /* 2e95dddb3SAnson Huang * Copyright (C) 2013 Freescale Semiconductor, Inc. 3e95dddb3SAnson Huang * 4e95dddb3SAnson Huang * The code contained herein is licensed under the GNU General Public 5e95dddb3SAnson Huang * License. You may obtain a copy of the GNU General Public License 6e95dddb3SAnson Huang * Version 2 or later at the following locations: 7e95dddb3SAnson Huang * 8e95dddb3SAnson Huang * http://www.opensource.org/licenses/gpl-license.html 9e95dddb3SAnson Huang * http://www.gnu.org/copyleft/gpl.html 10e95dddb3SAnson Huang */ 11e95dddb3SAnson Huang 12e95dddb3SAnson Huang #include <linux/err.h> 13e95dddb3SAnson Huang #include <linux/io.h> 14e95dddb3SAnson Huang #include <linux/of.h> 15e95dddb3SAnson Huang #include <linux/of_address.h> 16e95dddb3SAnson Huang #include <linux/mfd/syscon.h> 17e95dddb3SAnson Huang #include <linux/regmap.h> 18fcc4f9fcSFabio Estevam #include "common.h" 19f1c6f314SShawn Guo #include "hardware.h" 20e95dddb3SAnson Huang 21e95dddb3SAnson Huang #define REG_SET 0x4 22e95dddb3SAnson Huang #define REG_CLR 0x8 23e95dddb3SAnson Huang 24263475d4SAnson Huang #define ANADIG_REG_2P5 0x130 25e95dddb3SAnson Huang #define ANADIG_REG_CORE 0x140 26263475d4SAnson Huang #define ANADIG_ANA_MISC0 0x150 27e95dddb3SAnson Huang #define ANADIG_USB1_CHRG_DETECT 0x1b0 28e95dddb3SAnson Huang #define ANADIG_USB2_CHRG_DETECT 0x210 29e95dddb3SAnson Huang #define ANADIG_DIGPROG 0x260 30d8ce823fSShawn Guo #define ANADIG_DIGPROG_IMX6SL 0x280 31e95dddb3SAnson Huang 32263475d4SAnson Huang #define BM_ANADIG_REG_2P5_ENABLE_WEAK_LINREG 0x40000 33e95dddb3SAnson Huang #define BM_ANADIG_REG_CORE_FET_ODRIVE 0x20000000 34263475d4SAnson Huang #define BM_ANADIG_ANA_MISC0_STOP_MODE_CONFIG 0x1000 35e95dddb3SAnson Huang #define BM_ANADIG_USB_CHRG_DETECT_CHK_CHRG_B 0x80000 36e95dddb3SAnson Huang #define BM_ANADIG_USB_CHRG_DETECT_EN_B 0x100000 37e95dddb3SAnson Huang 38e95dddb3SAnson Huang static struct regmap *anatop; 39e95dddb3SAnson Huang 40263475d4SAnson Huang static void imx_anatop_enable_weak2p5(bool enable) 41263475d4SAnson Huang { 42263475d4SAnson Huang u32 reg, val; 43263475d4SAnson Huang 44263475d4SAnson Huang regmap_read(anatop, ANADIG_ANA_MISC0, &val); 45263475d4SAnson Huang 46263475d4SAnson Huang /* can only be enabled when stop_mode_config is clear. */ 47263475d4SAnson Huang reg = ANADIG_REG_2P5; 48263475d4SAnson Huang reg += (enable && (val & BM_ANADIG_ANA_MISC0_STOP_MODE_CONFIG) == 0) ? 49263475d4SAnson Huang REG_SET : REG_CLR; 50263475d4SAnson Huang regmap_write(anatop, reg, BM_ANADIG_REG_2P5_ENABLE_WEAK_LINREG); 51263475d4SAnson Huang } 52263475d4SAnson Huang 53e95dddb3SAnson Huang static void imx_anatop_enable_fet_odrive(bool enable) 54e95dddb3SAnson Huang { 55e95dddb3SAnson Huang regmap_write(anatop, ANADIG_REG_CORE + (enable ? REG_SET : REG_CLR), 56e95dddb3SAnson Huang BM_ANADIG_REG_CORE_FET_ODRIVE); 57e95dddb3SAnson Huang } 58e95dddb3SAnson Huang 59e95dddb3SAnson Huang void imx_anatop_pre_suspend(void) 60e95dddb3SAnson Huang { 61263475d4SAnson Huang imx_anatop_enable_weak2p5(true); 62e95dddb3SAnson Huang imx_anatop_enable_fet_odrive(true); 63e95dddb3SAnson Huang } 64e95dddb3SAnson Huang 65e95dddb3SAnson Huang void imx_anatop_post_resume(void) 66e95dddb3SAnson Huang { 67e95dddb3SAnson Huang imx_anatop_enable_fet_odrive(false); 68263475d4SAnson Huang imx_anatop_enable_weak2p5(false); 69e95dddb3SAnson Huang } 70e95dddb3SAnson Huang 71ddcb9aa6SPeter Chen static void imx_anatop_usb_chrg_detect_disable(void) 72e95dddb3SAnson Huang { 73e95dddb3SAnson Huang regmap_write(anatop, ANADIG_USB1_CHRG_DETECT, 74e95dddb3SAnson Huang BM_ANADIG_USB_CHRG_DETECT_EN_B 75e95dddb3SAnson Huang | BM_ANADIG_USB_CHRG_DETECT_CHK_CHRG_B); 76e95dddb3SAnson Huang regmap_write(anatop, ANADIG_USB2_CHRG_DETECT, 77e95dddb3SAnson Huang BM_ANADIG_USB_CHRG_DETECT_EN_B | 78e95dddb3SAnson Huang BM_ANADIG_USB_CHRG_DETECT_CHK_CHRG_B); 79e95dddb3SAnson Huang } 80e95dddb3SAnson Huang 81f1c6f314SShawn Guo void __init imx_init_revision_from_anatop(void) 82e95dddb3SAnson Huang { 837006ba24SShawn Guo struct device_node *np; 847006ba24SShawn Guo void __iomem *anatop_base; 85f1c6f314SShawn Guo unsigned int revision; 86f1c6f314SShawn Guo u32 digprog; 87d8ce823fSShawn Guo u16 offset = ANADIG_DIGPROG; 887006ba24SShawn Guo 897006ba24SShawn Guo np = of_find_compatible_node(NULL, NULL, "fsl,imx6q-anatop"); 907006ba24SShawn Guo anatop_base = of_iomap(np, 0); 917006ba24SShawn Guo WARN_ON(!anatop_base); 92d8ce823fSShawn Guo if (of_device_is_compatible(np, "fsl,imx6sl-anatop")) 93d8ce823fSShawn Guo offset = ANADIG_DIGPROG_IMX6SL; 94d8ce823fSShawn Guo digprog = readl_relaxed(anatop_base + offset); 95f1c6f314SShawn Guo iounmap(anatop_base); 967006ba24SShawn Guo 97f1c6f314SShawn Guo switch (digprog & 0xff) { 98f1c6f314SShawn Guo case 0: 99f1c6f314SShawn Guo revision = IMX_CHIP_REVISION_1_0; 100f1c6f314SShawn Guo break; 101f1c6f314SShawn Guo case 1: 102f1c6f314SShawn Guo revision = IMX_CHIP_REVISION_1_1; 103f1c6f314SShawn Guo break; 104f1c6f314SShawn Guo case 2: 105f1c6f314SShawn Guo revision = IMX_CHIP_REVISION_1_2; 106f1c6f314SShawn Guo break; 107c896e938SJason Liu case 3: 108c896e938SJason Liu revision = IMX_CHIP_REVISION_1_3; 109c896e938SJason Liu break; 110c896e938SJason Liu case 4: 111c896e938SJason Liu revision = IMX_CHIP_REVISION_1_4; 112c896e938SJason Liu break; 113c896e938SJason Liu case 5: 114c896e938SJason Liu /* 115c896e938SJason Liu * i.MX6DQ TO1.5 is defined as Rev 1.3 in Data Sheet, marked 116c896e938SJason Liu * as 'D' in Part Number last character. 117c896e938SJason Liu */ 118c896e938SJason Liu revision = IMX_CHIP_REVISION_1_5; 119c896e938SJason Liu break; 120f1c6f314SShawn Guo default: 121f1c6f314SShawn Guo revision = IMX_CHIP_REVISION_UNKNOWN; 122f1c6f314SShawn Guo } 123f1c6f314SShawn Guo 124f1c6f314SShawn Guo mxc_set_cpu_type(digprog >> 16 & 0xff); 125f1c6f314SShawn Guo imx_set_soc_revision(revision); 126e95dddb3SAnson Huang } 127e95dddb3SAnson Huang 128e95dddb3SAnson Huang void __init imx_anatop_init(void) 129e95dddb3SAnson Huang { 130e95dddb3SAnson Huang anatop = syscon_regmap_lookup_by_compatible("fsl,imx6q-anatop"); 131e95dddb3SAnson Huang if (IS_ERR(anatop)) { 132e95dddb3SAnson Huang pr_err("%s: failed to find imx6q-anatop regmap!\n", __func__); 133e95dddb3SAnson Huang return; 134e95dddb3SAnson Huang } 135ddcb9aa6SPeter Chen 136ddcb9aa6SPeter Chen imx_anatop_usb_chrg_detect_disable(); 137e95dddb3SAnson Huang } 138