static void s3c_pm_clear_eint(unsigned int irq) { u32 mask; /*clear pending*/ mask = readl(S5PV210_EINTPEND(eint_pend_reg(irq))); mask &= (eint_irq_to_bit(irq)); writel(mask, S5PV210_EINTPEND(eint_pend_reg(irq))); }
static int s3c_pm_enter(suspend_state_t state) { #ifndef USE_DMA_ALLOC static unsigned long regs_save[16]; #endif /* !USE_DMA_ALLOC */ unsigned int tmp,audiodomain_On; /* ensure the debug is initialised (if enabled) */ s3c_pm_debug_init(); S3C_PMDBG("%s(%d)\n", __func__, state); if (pm_cpu_prep == NULL || pm_cpu_sleep == NULL) { printk(KERN_ERR "%s: error: no cpu sleep function\n", __func__); return -EINVAL; } /* check if we have anything to wake-up with... bad things seem * to happen if you suspend with no wakeup (system will often * require a full power-cycle) */ s3c_irqwake_intmask = 0xFFFD; // rtc_alarm if (!any_allowed(s3c_irqwake_intmask, s3c_irqwake_intallow) && !any_allowed(s3c_irqwake_eintmask, s3c_irqwake_eintallow)) { printk(KERN_ERR "%s: No wake-up sources!\n", __func__); printk(KERN_ERR "%s: Aborting sleep\n", __func__); return -EINVAL; } /* store the physical address of the register recovery block */ #ifndef USE_DMA_ALLOC s3c_sleep_save_phys = virt_to_phys(regs_save); #else __raw_writel(phy_regs_save, S5P_INFORM2); #endif /* !USE_DMA_ALLOC */ /* set flag for sleep mode idle2 flag is also reserved */ __raw_writel(SLEEP_MODE, S5P_INFORM1); S3C_PMDBG("s3c_sleep_save_phys=0x%08lx\n", s3c_sleep_save_phys); /* save all necessary core registers not covered by the drivers */ s3c_pm_save_gpios(); s3c_pm_save_uarts(); s3c_pm_save_core(); s3c_config_sleep_gpio(); /* set the irq configuration for wake */ s3c_pm_configure_extint(); S3C_PMDBG("sleep: irq wakeup masks: %08lx,%08lx\n", s3c_irqwake_intmask, s3c_irqwake_eintmask); /*Set EINT as wake up source*/ #if defined(CONFIG_OPTICAL_GP2A) if(gp2a_get_proximity_enable()) { s3c_pm_set_eint(2, 0x4); // Proximity } #endif s3c_pm_set_eint( 6, 0x4); // det_3.5 s3c_pm_set_eint( 7, 0x2); // pmic s3c_pm_set_eint(11, 0x2); // onedram s3c_pm_set_eint(20, 0x3); // wifi s3c_pm_set_eint(21, 0x4); // bt s3c_pm_set_eint(22, 0x2); // power key s3c_pm_set_eint(23, 0x2); // microusb s3c_pm_set_eint(25, 0x4); // volume down s3c_pm_set_eint(26, 0x4); // volume up s3c_pm_set_eint(28, 0x4); // T_FLASH_DETECT s3c_pm_set_eint(29, 0x4); // ok key if(get_headset_status() & SEC_HEADSET_4_POLE_DEVICE) { s3c_pm_set_eint(30, 0x4); //sendend } else { s3c_pm_clear_eint(30); } //s3c_pm_arch_prepare_irqs(); /* call cpu specific preparation */ pm_cpu_prep(); /* flush cache back to ram */ flush_cache_all(); s3c_pm_check_store(); __raw_writel(s3c_irqwake_intmask, S5P_WAKEUP_MASK); //0xFFDD:key, RTC_ALARM /*clear for next wakeup*/ tmp = __raw_readl(S5P_WAKEUP_STAT); __raw_writel(tmp, S5P_WAKEUP_STAT); //s3c_config_sleep_gpio(); // Enable PS_HOLD pin to avoid reset failure */ __raw_writel((0x5 << 12 | 0x1<<9 | 0x1<<8 | 0x1<<0),S5P_PSHOLD_CONTROL); /* send the cpu to sleep... */ s3c_pm_arch_stop_clocks(); /* s3c_cpu_save will also act as our return point from when * we resume as it saves its own register state and restores it * during the resume. */ s3c_cpu_save(regs_save); /* restore the cpu state using the kernel's cpu init code. */ cpu_init(); /* restore the system state */ s3c_pm_restore_core(); /*Reset the uart registers*/ __raw_writel(0x0, S3C24XX_VA_UART3+S3C2410_UCON); __raw_writel(0xf, S3C24XX_VA_UART3+S5P_UINTM); __raw_writel(0xf, S3C24XX_VA_UART3+S5P_UINTSP); __raw_writel(0xf, S3C24XX_VA_UART3+S5P_UINTP); __raw_writel(0x0, S3C24XX_VA_UART2+S3C2410_UCON); __raw_writel(0xf, S3C24XX_VA_UART2+S5P_UINTM); __raw_writel(0xf, S3C24XX_VA_UART2+S5P_UINTSP); __raw_writel(0xf, S3C24XX_VA_UART2+S5P_UINTP); __raw_writel(0x0, S3C24XX_VA_UART1+S3C2410_UCON); __raw_writel(0xf, S3C24XX_VA_UART1+S5P_UINTM); __raw_writel(0xf, S3C24XX_VA_UART1+S5P_UINTSP); __raw_writel(0xf, S3C24XX_VA_UART1+S5P_UINTP); __raw_writel(0x0, S3C24XX_VA_UART0+S3C2410_UCON); __raw_writel(0xf, S3C24XX_VA_UART0+S5P_UINTM); __raw_writel(0xf, S3C24XX_VA_UART0+S5P_UINTSP); __raw_writel(0xf, S3C24XX_VA_UART0+S5P_UINTP); s3c_pm_restore_uarts(); s3c_pm_restore_gpios(); tmp = readl(S5P_NORMAL_CFG); if(!(tmp & S5PC110_POWER_DOMAIN_AUDIO)) { tmp = tmp | S5PC110_POWER_DOMAIN_AUDIO; writel(tmp , S5P_NORMAL_CFG); audiodomain_On = 1; } else { audiodomain_On = 0; } /* enable gpio, uart, mmc */ tmp = __raw_readl(S5P_OTHERS); tmp |= (1<<31) | (1<<30) | (1<<28) | (1<<29); __raw_writel(tmp, S5P_OTHERS); tmp = readl(S5P_NORMAL_CFG); if (audiodomain_On) { tmp = tmp & ~S5PC110_POWER_DOMAIN_AUDIO; writel(tmp , S5P_NORMAL_CFG); } /*clear for next wakeup*/ tmp = __raw_readl(S5P_WAKEUP_STAT); //printk("\nS5P_WAKEUP_STAT=%x\n",tmp); __raw_writel(tmp, S5P_WAKEUP_STAT); printk("wakeup source is 0x%x \n", tmp); printk(" EXT_INT_0_PEND %x \n", __raw_readl(S5PV210_EINTPEND(0))); printk(" EXT_INT_1_PEND %x \n", __raw_readl(S5PV210_EINTPEND(1))); printk(" EXT_INT_2_PEND %x \n", __raw_readl(S5PV210_EINTPEND(2))); printk(" EXT_INT_3_PEND %x \n", __raw_readl(S5PV210_EINTPEND(3))); s3c_pm_clear_eint(21); // s3c_pm_clear_eint(22); // to be cleared later /* check what irq (if any) restored the system */ s3c_pm_debug_init(); s3c_pm_arch_show_resume_irqs(); #if defined(CONFIG_MACH_S5PC110_P1) // Set wakeup stat s3c_pm_set_wakeup_stat(); #endif // CONFIG_MACH_S5PC110_P1 //printk("Int pending register before =%d\n",readl(S5PV210_EINTPEND(eint_pend_reg(22)))); //printk("Int pending register after =%d\n",readl(S5PV210_EINTPEND(eint_pend_reg(22)))); //S3C_PMDBG("%s: post sleep, preparing to return\n", __func__); //printk("%s: post sleep, preparing to return\n", __func__); /* LEDs should now be 1110 */ //s3c_pm_debug_smdkled(1 << 1, 0); s3c_pm_check_restore(); //mdelay(500); /* ok, let's return from sleep */ printk(KERN_ERR "\n%s:%d\n", __func__, __LINE__); S3C_PMDBG("S3C PM Resume (post-restore)\n"); return 0; }
// intr_mode 0x2=>falling edge, 0x3=>rising dege, 0x4=>Both edge static void s3c_pm_set_eint(unsigned int irq, unsigned int intr_mode) { int offs = (irq); int shift; u32 ctrl, mask, tmp; //u32 newvalue = 0x2; // Falling edge shift = (offs & 0x7) * 4; if((0 <= offs) && (offs < 8)){ tmp = readl(S5PV210_GPH0CON); tmp |= (0xf << shift); writel(tmp , S5PV210_GPH0CON); /*pull up disable*/ } else if((8 <= offs) && (offs < 16)){ tmp = readl(S5PV210_GPH1CON); tmp |= (0xf << shift); writel(tmp , S5PV210_GPH1CON); } else if((16 <= offs) && (offs < 24)){ tmp = readl(S5PV210_GPH2CON); tmp |= (0xf << shift); writel(tmp , S5PV210_GPH2CON); } else if((24 <= offs) && (offs < 32)){ tmp = readl(S5PV210_GPH3CON); tmp |= (0xf << shift); writel(tmp , S5PV210_GPH3CON); } else{ printk(KERN_ERR "No such irq number %d", offs); return; } /*special handling for keypad eint*/ if( (24 <= irq) && (irq <= 27)) {// disable the pull up tmp = readl(S5PV210_GPH3PUD); tmp &= ~(0x3 << ((offs & 0x7) * 2)); writel(tmp, S5PV210_GPH3PUD); DBG("S5PV210_GPH3PUD = %x\n",readl(S5PV210_GPH3PUD)); } /*Set irq type*/ mask = 0x7 << shift; ctrl = readl(S5PV210_EINTCON(eint_conf_reg(irq))); ctrl &= ~mask; //ctrl |= newvalue << shift; ctrl |= intr_mode << shift; writel(ctrl, S5PV210_EINTCON(eint_conf_reg(irq))); /*clear mask*/ mask = readl(S5PV210_EINTMASK(eint_mask_reg(irq))); mask &= ~(eint_irq_to_bit(irq)); writel(mask, S5PV210_EINTMASK(eint_mask_reg(irq))); /*clear pending*/ mask = readl(S5PV210_EINTPEND(eint_pend_reg(irq))); mask &= (eint_irq_to_bit(irq)); writel(mask, S5PV210_EINTPEND(eint_pend_reg(irq))); /*Enable wake up mask*/ tmp = readl(S5P_EINT_WAKEUP_MASK); tmp &= ~(1 << (irq)); writel(tmp , S5P_EINT_WAKEUP_MASK); DBG("S5PV210_EINTCON = %x\n",readl(S5PV210_EINTCON(eint_conf_reg(irq)))); DBG("S5PV210_EINTMASK = %x\n",readl(S5PV210_EINTMASK(eint_mask_reg(irq)))); DBG("S5PV210_EINTPEND = %x\n",readl(S5PV210_EINTPEND(eint_pend_reg(irq)))); return; }
static int s3c_pm_enter(suspend_state_t state) { #ifndef USE_DMA_ALLOC static unsigned long regs_save[16]; #endif /* !USE_DMA_ALLOC */ unsigned int tmp,audiodomain_On; /* ensure the debug is initialised (if enabled) */ s3c_pm_debug_init(); S3C_PMDBG("%s(%d)\n", __func__, state); if (pm_cpu_prep == NULL || pm_cpu_sleep == NULL) { printk(KERN_ERR "%s: error: no cpu sleep function\n", __func__); return -EINVAL; } /* check if we have anything to wake-up with... bad things seem * to happen if you suspend with no wakeup (system will often * require a full power-cycle) */ s3c_irqwake_intmask = 0xFFFD; // rtc_alarm if (!any_allowed(s3c_irqwake_intmask, s3c_irqwake_intallow) && !any_allowed(s3c_irqwake_eintmask, s3c_irqwake_eintallow)) { printk(KERN_ERR "%s: No wake-up sources!\n", __func__); printk(KERN_ERR "%s: Aborting sleep\n", __func__); return -EINVAL; } /* store the physical address of the register recovery block */ #ifndef USE_DMA_ALLOC s3c_sleep_save_phys = virt_to_phys(regs_save); #else __raw_writel(phy_regs_save, S5P_INFORM2); #endif /* !USE_DMA_ALLOC */ /* set flag for sleep mode idle2 flag is also reserved */ __raw_writel(SLEEP_MODE, S5P_INFORM1); S3C_PMDBG("s3c_sleep_save_phys=0x%08lx\n", s3c_sleep_save_phys); /* save all necessary core registers not covered by the drivers */ s3c_pm_save_gpios(); s3c_pm_save_uarts(); s3c_pm_save_core(); s3c_config_sleep_gpio(); /* set the irq configuration for wake */ s3c_pm_configure_extint(); S3C_PMDBG("sleep: irq wakeup masks: %08lx,%08lx\n", s3c_irqwake_intmask, s3c_irqwake_eintmask); /*Set EINT as wake up source*/ #if defined(CONFIG_OPTICAL_GP2A) || defined(CONFIG_S5PC110_DEMPSEY_BOARD) if(gp2a_get_proximity_enable()) { s3c_pm_set_eint(2, 0x4); // Proximity } #endif #if defined(CONFIG_S5PC110_DEMPSEY_BOARD) s3c_pm_set_eint( 6, 0x4); // det_3.5 s3c_pm_set_eint( 7, 0x2); // pmic s3c_pm_set_eint(11, 0x2); // onedram #if defined (CONFIG_CP_CHIPSET_STE) s3c_pm_set_eint(12, 0x2); //INT_RESOUT s3c_pm_set_eint(9, 0x2); //INT_CP_PWR_RST #else s3c_pm_set_eint(15, 0x4); //PHONE_ACTIVE #endif // s3c_pm_set_eint(20, 0x3); // wifi s3c_pm_set_eint(21, 0x4); // bt s3c_pm_set_eint(22, 0x2); // power key s3c_pm_set_eint(23, 0x2); // microusb // s3c_pm_set_eint(28, 0x4); // T_FLASH_DETECT: NC // s3c_pm_set_eint(29, 0x4); // GYRO_INT if(get_headset_status() & SEC_HEADSET_4_POLE_DEVICE) { s3c_pm_set_eint(30, 0x4); //sendend } else { s3c_pm_clear_eint(30); } #elif defined (CONFIG_S5PC110_HAWK_BOARD) /*Set EINT 22 as wake up source*/ s3c_pm_set_eint(11, 0x2); // nINT_ONEDRAM_AP #if defined(CONFIG_HAWK_VER_B1_REAL_ADDED_FEATURE) //NAGSM_Android_HQ_KERNEL_CLEE_20100908 : Setup Hawk Real Board Rev 0.1 s3c_pm_set_eint(31, 0x2); // nPower s3c_pm_set_eint(24, 0x2); // Home key #else s3c_pm_set_eint(22, 0x2); // nPower #endif #if defined (CONFIG_CP_CHIPSET_STE) s3c_pm_set_eint(12, 0x2); //INT_RESOUT s3c_pm_set_eint(9, 0x2); //INT_CP_PWR_RST #else s3c_pm_set_eint(15, 0x4); //PHONE_ACTIVE #endif s3c_pm_set_eint(21, 0x4); // BT_HOST_WAKE s3c_pm_set_eint(7, 0x02); //PMIC s3c_pm_set_eint(6, 0x4); //det_3.5 s3c_pm_set_eint(28, 0x4); // T_FLASH_DETECT #elif defined (CONFIG_S5PC110_VIBRANTPLUS_BOARD) s3c_pm_set_eint( 6, 0x4); // det_3.5 s3c_pm_set_eint( 7, 0x2); // pmic s3c_pm_set_eint(11, 0x2); // onedram #if defined (CONFIG_CP_CHIPSET_STE) s3c_pm_set_eint(12, 0x2); //INT_RESOUT s3c_pm_set_eint(9, 0x2); //INT_CP_PWR_RST #else s3c_pm_set_eint(15, 0x4); //PHONE_ACTIVE #endif s3c_pm_set_eint(20, 0x3); // wifi s3c_pm_set_eint(21, 0x4); // bt s3c_pm_set_eint(22, 0x2); // power key s3c_pm_set_eint(23, 0x2); // microusb if((is_calling_or_playing & IS_VOICE_CALL_2G) || (is_calling_or_playing & IS_VOICE_CALL_3G) || (is_calling_or_playing & IS_DATA_CALL)){ s3c_pm_set_eint(25, 0x4); //volume up s3c_pm_set_eint(26, 0x4); //volume down } s3c_pm_set_eint(28, 0x4); // T_FLASH_DETECT #else s3c_pm_set_eint( 6, 0x4); // det_3.5 s3c_pm_set_eint( 7, 0x2); // pmic s3c_pm_set_eint(11, 0x2); // onedram #if defined (CONFIG_CP_CHIPSET_STE) s3c_pm_set_eint(12, 0x2); //INT_RESOUT s3c_pm_set_eint(9, 0x2); //INT_CP_PWR_RST #else s3c_pm_set_eint(15, 0x4); //PHONE_ACTIVE #endif s3c_pm_set_eint(20, 0x3); // wifi s3c_pm_set_eint(21, 0x4); // bt s3c_pm_set_eint(22, 0x2); // power key s3c_pm_set_eint(23, 0x2); // microusb s3c_pm_set_eint(25, 0x4); // volume down s3c_pm_set_eint(26, 0x4); // volume up s3c_pm_set_eint(28, 0x4); // T_FLASH_DETECT /* s3c_pm_set_eint(29, 0x4); // ok key if(get_headset_status() & SEC_HEADSET_4_POLE_DEVICE) { s3c_pm_set_eint(30, 0x4); //sendend } else { s3c_pm_clear_eint(30); } */ #endif #if defined CONFIG_T959_VER_B0 s3c_pm_set_eint(29, 0x4); // [[junghyunseok edit for fuel_int interrupt control of fuel_gauge 20100504 #elif defined CONFIG_KEPLER_VER_B0 #elif defined(CONFIG_KEPLER_VER_B2) || defined(CONFIG_T959_VER_B5) || defined (CONFIG_S5PC110_VIBRANTPLUS_BOARD) || defined(CONFIG_S5PC110_DEMPSEY_BOARD) s3c_pm_set_eint(27, 0x2); // ]]junghyunseok edit for fuel_int interrupt control of fuel_gauge 20100504 #else //gpio key if(HWREV >= 0xB) { s3c_pm_set_eint(27, 0x4); s3c_pm_set_eint(29, 0x4); } #endif //[hdlnc_bp_ytkwon : 20100326 // #ifdef CONFIG_KEPLER_AUDIO_A1026 #if defined(CONFIG_S5PC110_KEPLER_BOARD) if(HWREV!=0x08) { if(get_headset_status() & SEC_HEADSET_4_POLE_DEVICE) { s3c_pm_set_eint(30, 0x4); //sendend s3c_pm_set_eint(18, 0x4); //sendend 2.5 } else { s3c_pm_clear_eint(30); s3c_pm_clear_eint(18); } } #elif defined(CONFIG_S5PC110_T959_BOARD) if(HWREV==0x0a ||HWREV==0x0c) { if(get_headset_status() & SEC_HEADSET_4_POLE_DEVICE) { s3c_pm_set_eint(30, 0x4); //sendend } else { s3c_pm_clear_eint(30); } } else { if(get_headset_status() & SEC_HEADSET_4_POLE_DEVICE) { s3c_pm_set_eint(30, 0x4); //sendend s3c_pm_set_eint(18, 0x4); //sendend 2.5 } else { s3c_pm_clear_eint(30); s3c_pm_clear_eint(18); } } #else //sidekick, hawk, vibrantplus if(get_headset_status() & SEC_HEADSET_4_POLE_DEVICE) { s3c_pm_set_eint(30, 0x4); //sendend s3c_pm_set_eint(18, 0x4); //sendend 2.5 } else { s3c_pm_clear_eint(30); s3c_pm_clear_eint(18); } #endif //]hdlnc_bp_ytkwon : 20100326 #if defined (CONFIG_S5PC110_HAWK_BOARD) if(gp2a_get_proximity_enable()) { #if defined(CONFIG_HAWK_VER_B1_REAL_ADDED_FEATURE) //NAGSM_Android_HQ_KERNEL_CLEE_20100928 : Setup Hawk Real Board Rev 0.1 Proximity sensor s3c_pm_set_eint(10, 0x2);//proximity #else s3c_pm_set_eint(2, 0x4);//proximity #endif } s3c_pm_set_eint(20, 0x3);//WiFi s3c_pm_set_eint(23, 0x2);//microusb #endif //s3c_pm_arch_prepare_irqs(); /* call cpu specific preparation */ pm_cpu_prep(); /* flush cache back to ram */ flush_cache_all(); s3c_pm_check_store(); // __raw_writel(s3c_irqwake_intmask, S5P_WAKEUP_MASK); //0xFFDD:key, RTC_ALARM if((is_calling_or_playing & IS_VOICE_CALL_2G) || (is_calling_or_playing & IS_VOICE_CALL_3G) || (is_calling_or_playing & IS_DATA_CALL)){ __raw_writel(0xFFDD, S5P_WAKEUP_MASK); //0xFFDD:key, RTC_ALARM }else{ __raw_writel(0xFFFD, S5P_WAKEUP_MASK); //0xFFDD:key, RTC_ALARM } /*clear for next wakeup*/ tmp = __raw_readl(S5P_WAKEUP_STAT); __raw_writel(tmp, S5P_WAKEUP_STAT); //s3c_config_sleep_gpio(); // Enable PS_HOLD pin to avoid reset failure */ __raw_writel((0x5 << 12 | 0x1<<9 | 0x1<<8 | 0x1<<0),S5P_PSHOLD_CONTROL); /* send the cpu to sleep... */ s3c_pm_arch_stop_clocks(); /* s3c_cpu_save will also act as our return point from when * we resume as it saves its own register state and restores it * during the resume. */ s3c_cpu_save(regs_save); /* restore the cpu state using the kernel's cpu init code. */ cpu_init(); /* restore the system state */ s3c_pm_restore_core(); /*Reset the uart registers*/ __raw_writel(0x0, S3C24XX_VA_UART3+S3C2410_UCON); __raw_writel(0xf, S3C24XX_VA_UART3+S5P_UINTM); __raw_writel(0xf, S3C24XX_VA_UART3+S5P_UINTSP); __raw_writel(0xf, S3C24XX_VA_UART3+S5P_UINTP); __raw_writel(0x0, S3C24XX_VA_UART2+S3C2410_UCON); __raw_writel(0xf, S3C24XX_VA_UART2+S5P_UINTM); __raw_writel(0xf, S3C24XX_VA_UART2+S5P_UINTSP); __raw_writel(0xf, S3C24XX_VA_UART2+S5P_UINTP); __raw_writel(0x0, S3C24XX_VA_UART1+S3C2410_UCON); __raw_writel(0xf, S3C24XX_VA_UART1+S5P_UINTM); __raw_writel(0xf, S3C24XX_VA_UART1+S5P_UINTSP); __raw_writel(0xf, S3C24XX_VA_UART1+S5P_UINTP); __raw_writel(0x0, S3C24XX_VA_UART0+S3C2410_UCON); __raw_writel(0xf, S3C24XX_VA_UART0+S5P_UINTM); __raw_writel(0xf, S3C24XX_VA_UART0+S5P_UINTSP); __raw_writel(0xf, S3C24XX_VA_UART0+S5P_UINTP); s3c_pm_restore_uarts(); s3c_pm_restore_gpios(); /* enable gpio, uart, mmc */ tmp = __raw_readl(S5P_OTHERS); tmp |= (1<<31) | (1<<30) | (1<<28) | (1<<29); __raw_writel(tmp, S5P_OTHERS); /*clear for next wakeup*/ tmp = __raw_readl(S5P_WAKEUP_STAT); //printk("\nS5P_WAKEUP_STAT=%x\n",tmp); __raw_writel(tmp, S5P_WAKEUP_STAT); printk("wakeup source is 0x%x \n", tmp); printk(" EXT_INT_0_PEND %x \n", __raw_readl(S5PV210_EINTPEND(0))); printk(" EXT_INT_1_PEND %x \n", __raw_readl(S5PV210_EINTPEND(1))); printk(" EXT_INT_2_PEND %x \n", __raw_readl(S5PV210_EINTPEND(2))); printk(" EXT_INT_3_PEND %x \n", __raw_readl(S5PV210_EINTPEND(3))); #if defined(CONFIG_S5PC110_HAWK_BOARD) // s3c_pm_clear_eint(21); #else s3c_pm_clear_eint(21); #endif // s3c_pm_clear_eint(22); // to be cleared later /* check what irq (if any) restored the system */ s3c_pm_debug_init(); s3c_pm_arch_show_resume_irqs(); #if defined(CONFIG_MACH_S5PC110_P1) // Set wakeup stat s3c_pm_set_wakeup_stat(); #endif // CONFIG_MACH_S5PC110_P1 //printk("Int pending register before =%d\n",readl(S5PV210_EINTPEND(eint_pend_reg(22)))); //printk("Int pending register after =%d\n",readl(S5PV210_EINTPEND(eint_pend_reg(22)))); //S3C_PMDBG("%s: post sleep, preparing to return\n", __func__); //printk("%s: post sleep, preparing to return\n", __func__); /* LEDs should now be 1110 */ //s3c_pm_debug_smdkled(1 << 1, 0); s3c_pm_check_restore(); //mdelay(500); /* ok, let's return from sleep */ printk(KERN_ERR "\n%s:%d\n", __func__, __LINE__); S3C_PMDBG("S3C PM Resume (post-restore)\n"); return 0; }