diff options
Diffstat (limited to 'ANDROID_3.4.5/drivers/mfd/twl4030-power.c')
| -rw-r--r-- | ANDROID_3.4.5/drivers/mfd/twl4030-power.c | 607 |
1 files changed, 0 insertions, 607 deletions
diff --git a/ANDROID_3.4.5/drivers/mfd/twl4030-power.c b/ANDROID_3.4.5/drivers/mfd/twl4030-power.c deleted file mode 100644 index 79ca33df..00000000 --- a/ANDROID_3.4.5/drivers/mfd/twl4030-power.c +++ /dev/null @@ -1,607 +0,0 @@ -/* - * linux/drivers/i2c/chips/twl4030-power.c - * - * Handle TWL4030 Power initialization - * - * Copyright (C) 2008 Nokia Corporation - * Copyright (C) 2006 Texas Instruments, Inc - * - * Written by Kalle Jokiniemi - * Peter De Schrijver <peter.de-schrijver@nokia.com> - * Several fixes by Amit Kucheria <amit.kucheria@verdurent.com> - * - * This file is subject to the terms and conditions of the GNU General - * Public License. See the file "COPYING" in the main directory of this - * archive for more details. - * - * This program is distributed in the hope that it will be useful, - * but WITHOUT ANY WARRANTY; without even the implied warranty of - * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the - * GNU General Public License for more details. - * - * You should have received a copy of the GNU General Public License - * along with this program; if not, write to the Free Software - * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA - */ - -#include <linux/module.h> -#include <linux/pm.h> -#include <linux/i2c/twl.h> -#include <linux/platform_device.h> - -#include <asm/mach-types.h> - -static u8 twl4030_start_script_address = 0x2b; - -#define PWR_P1_SW_EVENTS 0x10 -#define PWR_DEVOFF (1 << 0) -#define SEQ_OFFSYNC (1 << 0) - -#define PHY_TO_OFF_PM_MASTER(p) (p - 0x36) -#define PHY_TO_OFF_PM_RECEIVER(p) (p - 0x5b) - -/* resource - hfclk */ -#define R_HFCLKOUT_DEV_GRP PHY_TO_OFF_PM_RECEIVER(0xe6) - -/* PM events */ -#define R_P1_SW_EVENTS PHY_TO_OFF_PM_MASTER(0x46) -#define R_P2_SW_EVENTS PHY_TO_OFF_PM_MASTER(0x47) -#define R_P3_SW_EVENTS PHY_TO_OFF_PM_MASTER(0x48) -#define R_CFG_P1_TRANSITION PHY_TO_OFF_PM_MASTER(0x36) -#define R_CFG_P2_TRANSITION PHY_TO_OFF_PM_MASTER(0x37) -#define R_CFG_P3_TRANSITION PHY_TO_OFF_PM_MASTER(0x38) - -#define LVL_WAKEUP 0x08 - -#define ENABLE_WARMRESET (1<<4) - -#define END_OF_SCRIPT 0x3f - -#define R_SEQ_ADD_A2S PHY_TO_OFF_PM_MASTER(0x55) -#define R_SEQ_ADD_S2A12 PHY_TO_OFF_PM_MASTER(0x56) -#define R_SEQ_ADD_S2A3 PHY_TO_OFF_PM_MASTER(0x57) -#define R_SEQ_ADD_WARM PHY_TO_OFF_PM_MASTER(0x58) -#define R_MEMORY_ADDRESS PHY_TO_OFF_PM_MASTER(0x59) -#define R_MEMORY_DATA PHY_TO_OFF_PM_MASTER(0x5a) - -/* resource configuration registers - <RESOURCE>_DEV_GRP at address 'n+0' - <RESOURCE>_TYPE at address 'n+1' - <RESOURCE>_REMAP at address 'n+2' - <RESOURCE>_DEDICATED at address 'n+3' -*/ -#define DEV_GRP_OFFSET 0 -#define TYPE_OFFSET 1 -#define REMAP_OFFSET 2 -#define DEDICATED_OFFSET 3 - -/* Bit positions in the registers */ - -/* <RESOURCE>_DEV_GRP */ -#define DEV_GRP_SHIFT 5 -#define DEV_GRP_MASK (7 << DEV_GRP_SHIFT) - -/* <RESOURCE>_TYPE */ -#define TYPE_SHIFT 0 -#define TYPE_MASK (7 << TYPE_SHIFT) -#define TYPE2_SHIFT 3 -#define TYPE2_MASK (3 << TYPE2_SHIFT) - -/* <RESOURCE>_REMAP */ -#define SLEEP_STATE_SHIFT 0 -#define SLEEP_STATE_MASK (0xf << SLEEP_STATE_SHIFT) -#define OFF_STATE_SHIFT 4 -#define OFF_STATE_MASK (0xf << OFF_STATE_SHIFT) - -static u8 res_config_addrs[] = { - [RES_VAUX1] = 0x17, - [RES_VAUX2] = 0x1b, - [RES_VAUX3] = 0x1f, - [RES_VAUX4] = 0x23, - [RES_VMMC1] = 0x27, - [RES_VMMC2] = 0x2b, - [RES_VPLL1] = 0x2f, - [RES_VPLL2] = 0x33, - [RES_VSIM] = 0x37, - [RES_VDAC] = 0x3b, - [RES_VINTANA1] = 0x3f, - [RES_VINTANA2] = 0x43, - [RES_VINTDIG] = 0x47, - [RES_VIO] = 0x4b, - [RES_VDD1] = 0x55, - [RES_VDD2] = 0x63, - [RES_VUSB_1V5] = 0x71, - [RES_VUSB_1V8] = 0x74, - [RES_VUSB_3V1] = 0x77, - [RES_VUSBCP] = 0x7a, - [RES_REGEN] = 0x7f, - [RES_NRES_PWRON] = 0x82, - [RES_CLKEN] = 0x85, - [RES_SYSEN] = 0x88, - [RES_HFCLKOUT] = 0x8b, - [RES_32KCLKOUT] = 0x8e, - [RES_RESET] = 0x91, - [RES_MAIN_REF] = 0x94, -}; - -static int __devinit twl4030_write_script_byte(u8 address, u8 byte) -{ - int err; - - err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, address, - R_MEMORY_ADDRESS); - if (err) - goto out; - err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, byte, - R_MEMORY_DATA); -out: - return err; -} - -static int __devinit twl4030_write_script_ins(u8 address, u16 pmb_message, - u8 delay, u8 next) -{ - int err; - - address *= 4; - err = twl4030_write_script_byte(address++, pmb_message >> 8); - if (err) - goto out; - err = twl4030_write_script_byte(address++, pmb_message & 0xff); - if (err) - goto out; - err = twl4030_write_script_byte(address++, delay); - if (err) - goto out; - err = twl4030_write_script_byte(address++, next); -out: - return err; -} - -static int __devinit twl4030_write_script(u8 address, struct twl4030_ins *script, - int len) -{ - int err; - - for (; len; len--, address++, script++) { - if (len == 1) { - err = twl4030_write_script_ins(address, - script->pmb_message, - script->delay, - END_OF_SCRIPT); - if (err) - break; - } else { - err = twl4030_write_script_ins(address, - script->pmb_message, - script->delay, - address + 1); - if (err) - break; - } - } - return err; -} - -static int __devinit twl4030_config_wakeup3_sequence(u8 address) -{ - int err; - u8 data; - - /* Set SLEEP to ACTIVE SEQ address for P3 */ - err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, address, - R_SEQ_ADD_S2A3); - if (err) - goto out; - - /* P3 LVL_WAKEUP should be on LEVEL */ - err = twl_i2c_read_u8(TWL4030_MODULE_PM_MASTER, &data, - R_P3_SW_EVENTS); - if (err) - goto out; - data |= LVL_WAKEUP; - err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, data, - R_P3_SW_EVENTS); -out: - if (err) - pr_err("TWL4030 wakeup sequence for P3 config error\n"); - return err; -} - -static int __devinit twl4030_config_wakeup12_sequence(u8 address) -{ - int err = 0; - u8 data; - - /* Set SLEEP to ACTIVE SEQ address for P1 and P2 */ - err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, address, - R_SEQ_ADD_S2A12); - if (err) - goto out; - - /* P1/P2 LVL_WAKEUP should be on LEVEL */ - err = twl_i2c_read_u8(TWL4030_MODULE_PM_MASTER, &data, - R_P1_SW_EVENTS); - if (err) - goto out; - - data |= LVL_WAKEUP; - err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, data, - R_P1_SW_EVENTS); - if (err) - goto out; - - err = twl_i2c_read_u8(TWL4030_MODULE_PM_MASTER, &data, - R_P2_SW_EVENTS); - if (err) - goto out; - - data |= LVL_WAKEUP; - err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, data, - R_P2_SW_EVENTS); - if (err) - goto out; - - if (machine_is_omap_3430sdp() || machine_is_omap_ldp()) { - /* Disabling AC charger effect on sleep-active transitions */ - err = twl_i2c_read_u8(TWL4030_MODULE_PM_MASTER, &data, - R_CFG_P1_TRANSITION); - if (err) - goto out; - data &= ~(1<<1); - err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, data , - R_CFG_P1_TRANSITION); - if (err) - goto out; - } - -out: - if (err) - pr_err("TWL4030 wakeup sequence for P1 and P2" \ - "config error\n"); - return err; -} - -static int __devinit twl4030_config_sleep_sequence(u8 address) -{ - int err; - - /* Set ACTIVE to SLEEP SEQ address in T2 memory*/ - err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, address, - R_SEQ_ADD_A2S); - - if (err) - pr_err("TWL4030 sleep sequence config error\n"); - - return err; -} - -static int __devinit twl4030_config_warmreset_sequence(u8 address) -{ - int err; - u8 rd_data; - - /* Set WARM RESET SEQ address for P1 */ - err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, address, - R_SEQ_ADD_WARM); - if (err) - goto out; - - /* P1/P2/P3 enable WARMRESET */ - err = twl_i2c_read_u8(TWL4030_MODULE_PM_MASTER, &rd_data, - R_P1_SW_EVENTS); - if (err) - goto out; - - rd_data |= ENABLE_WARMRESET; - err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, rd_data, - R_P1_SW_EVENTS); - if (err) - goto out; - - err = twl_i2c_read_u8(TWL4030_MODULE_PM_MASTER, &rd_data, - R_P2_SW_EVENTS); - if (err) - goto out; - - rd_data |= ENABLE_WARMRESET; - err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, rd_data, - R_P2_SW_EVENTS); - if (err) - goto out; - - err = twl_i2c_read_u8(TWL4030_MODULE_PM_MASTER, &rd_data, - R_P3_SW_EVENTS); - if (err) - goto out; - - rd_data |= ENABLE_WARMRESET; - err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, rd_data, - R_P3_SW_EVENTS); -out: - if (err) - pr_err("TWL4030 warmreset seq config error\n"); - return err; -} - -static int __devinit twl4030_configure_resource(struct twl4030_resconfig *rconfig) -{ - int rconfig_addr; - int err; - u8 type; - u8 grp; - u8 remap; - - if (rconfig->resource > TOTAL_RESOURCES) { - pr_err("TWL4030 Resource %d does not exist\n", - rconfig->resource); - return -EINVAL; - } - - rconfig_addr = res_config_addrs[rconfig->resource]; - - /* Set resource group */ - err = twl_i2c_read_u8(TWL4030_MODULE_PM_RECEIVER, &grp, - rconfig_addr + DEV_GRP_OFFSET); - if (err) { - pr_err("TWL4030 Resource %d group could not be read\n", - rconfig->resource); - return err; - } - - if (rconfig->devgroup != TWL4030_RESCONFIG_UNDEF) { - grp &= ~DEV_GRP_MASK; - grp |= rconfig->devgroup << DEV_GRP_SHIFT; - err = twl_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER, - grp, rconfig_addr + DEV_GRP_OFFSET); - if (err < 0) { - pr_err("TWL4030 failed to program devgroup\n"); - return err; - } - } - - /* Set resource types */ - err = twl_i2c_read_u8(TWL4030_MODULE_PM_RECEIVER, &type, - rconfig_addr + TYPE_OFFSET); - if (err < 0) { - pr_err("TWL4030 Resource %d type could not be read\n", - rconfig->resource); - return err; - } - - if (rconfig->type != TWL4030_RESCONFIG_UNDEF) { - type &= ~TYPE_MASK; - type |= rconfig->type << TYPE_SHIFT; - } - - if (rconfig->type2 != TWL4030_RESCONFIG_UNDEF) { - type &= ~TYPE2_MASK; - type |= rconfig->type2 << TYPE2_SHIFT; - } - - err = twl_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER, - type, rconfig_addr + TYPE_OFFSET); - if (err < 0) { - pr_err("TWL4030 failed to program resource type\n"); - return err; - } - - /* Set remap states */ - err = twl_i2c_read_u8(TWL4030_MODULE_PM_RECEIVER, &remap, - rconfig_addr + REMAP_OFFSET); - if (err < 0) { - pr_err("TWL4030 Resource %d remap could not be read\n", - rconfig->resource); - return err; - } - - if (rconfig->remap_off != TWL4030_RESCONFIG_UNDEF) { - remap &= ~OFF_STATE_MASK; - remap |= rconfig->remap_off << OFF_STATE_SHIFT; - } - - if (rconfig->remap_sleep != TWL4030_RESCONFIG_UNDEF) { - remap &= ~SLEEP_STATE_MASK; - remap |= rconfig->remap_sleep << SLEEP_STATE_SHIFT; - } - - err = twl_i2c_write_u8(TWL4030_MODULE_PM_RECEIVER, - remap, - rconfig_addr + REMAP_OFFSET); - if (err < 0) { - pr_err("TWL4030 failed to program remap\n"); - return err; - } - - return 0; -} - -static int __devinit load_twl4030_script(struct twl4030_script *tscript, - u8 address) -{ - int err; - static int order; - - /* Make sure the script isn't going beyond last valid address (0x3f) */ - if ((address + tscript->size) > END_OF_SCRIPT) { - pr_err("TWL4030 scripts too big error\n"); - return -EINVAL; - } - - err = twl4030_write_script(address, tscript->script, tscript->size); - if (err) - goto out; - - if (tscript->flags & TWL4030_WRST_SCRIPT) { - err = twl4030_config_warmreset_sequence(address); - if (err) - goto out; - } - if (tscript->flags & TWL4030_WAKEUP12_SCRIPT) { - err = twl4030_config_wakeup12_sequence(address); - if (err) - goto out; - order = 1; - } - if (tscript->flags & TWL4030_WAKEUP3_SCRIPT) { - err = twl4030_config_wakeup3_sequence(address); - if (err) - goto out; - } - if (tscript->flags & TWL4030_SLEEP_SCRIPT) { - if (!order) - pr_warning("TWL4030: Bad order of scripts (sleep "\ - "script before wakeup) Leads to boot"\ - "failure on some boards\n"); - err = twl4030_config_sleep_sequence(address); - } -out: - return err; -} - -int twl4030_remove_script(u8 flags) -{ - int err = 0; - - err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, - TWL4030_PM_MASTER_KEY_CFG1, - TWL4030_PM_MASTER_PROTECT_KEY); - if (err) { - pr_err("twl4030: unable to unlock PROTECT_KEY\n"); - return err; - } - - err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, - TWL4030_PM_MASTER_KEY_CFG2, - TWL4030_PM_MASTER_PROTECT_KEY); - if (err) { - pr_err("twl4030: unable to unlock PROTECT_KEY\n"); - return err; - } - - if (flags & TWL4030_WRST_SCRIPT) { - err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, END_OF_SCRIPT, - R_SEQ_ADD_WARM); - if (err) - return err; - } - if (flags & TWL4030_WAKEUP12_SCRIPT) { - err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, END_OF_SCRIPT, - R_SEQ_ADD_S2A12); - if (err) - return err; - } - if (flags & TWL4030_WAKEUP3_SCRIPT) { - err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, END_OF_SCRIPT, - R_SEQ_ADD_S2A3); - if (err) - return err; - } - if (flags & TWL4030_SLEEP_SCRIPT) { - err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, END_OF_SCRIPT, - R_SEQ_ADD_A2S); - if (err) - return err; - } - - err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, 0, - TWL4030_PM_MASTER_PROTECT_KEY); - if (err) - pr_err("TWL4030 Unable to relock registers\n"); - - return err; -} - -/* - * In master mode, start the power off sequence. - * After a successful execution, TWL shuts down the power to the SoC - * and all peripherals connected to it. - */ -void twl4030_power_off(void) -{ - int err; - - err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, PWR_DEVOFF, - TWL4030_PM_MASTER_P1_SW_EVENTS); - if (err) - pr_err("TWL4030 Unable to power off\n"); -} - -void __devinit twl4030_power_init(struct twl4030_power_data *twl4030_scripts) -{ - int err = 0; - int i; - struct twl4030_resconfig *resconfig; - u8 val, address = twl4030_start_script_address; - - err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, - TWL4030_PM_MASTER_KEY_CFG1, - TWL4030_PM_MASTER_PROTECT_KEY); - if (err) - goto unlock; - - err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, - TWL4030_PM_MASTER_KEY_CFG2, - TWL4030_PM_MASTER_PROTECT_KEY); - if (err) - goto unlock; - - for (i = 0; i < twl4030_scripts->num; i++) { - err = load_twl4030_script(twl4030_scripts->scripts[i], address); - if (err) - goto load; - address += twl4030_scripts->scripts[i]->size; - } - - resconfig = twl4030_scripts->resource_config; - if (resconfig) { - while (resconfig->resource) { - err = twl4030_configure_resource(resconfig); - if (err) - goto resource; - resconfig++; - - } - } - - /* Board has to be wired properly to use this feature */ - if (twl4030_scripts->use_poweroff && !pm_power_off) { - /* Default for SEQ_OFFSYNC is set, lets ensure this */ - err = twl_i2c_read_u8(TWL4030_MODULE_PM_MASTER, &val, - TWL4030_PM_MASTER_CFG_P123_TRANSITION); - if (err) { - pr_warning("TWL4030 Unable to read registers\n"); - - } else if (!(val & SEQ_OFFSYNC)) { - val |= SEQ_OFFSYNC; - err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, val, - TWL4030_PM_MASTER_CFG_P123_TRANSITION); - if (err) { - pr_err("TWL4030 Unable to setup SEQ_OFFSYNC\n"); - goto relock; - } - } - - pm_power_off = twl4030_power_off; - } - -relock: - err = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, 0, - TWL4030_PM_MASTER_PROTECT_KEY); - if (err) - pr_err("TWL4030 Unable to relock registers\n"); - return; - -unlock: - if (err) - pr_err("TWL4030 Unable to unlock registers\n"); - return; -load: - if (err) - pr_err("TWL4030 failed to load scripts\n"); - return; -resource: - if (err) - pr_err("TWL4030 failed to configure resource\n"); - return; -} |