static int pxa_pm_enter(u32 state) { unsigned long sleep_save[SLEEP_SAVE_SIZE]; unsigned long checksum = 0; unsigned long delta; int i; if (state != PM_SUSPEND_MEM) return -EINVAL; /* preserve current time */ delta = xtime.tv_sec - RCNR; /* * Temporary solution. This won't be necessary once * we move pxa support into the serial driver * Save the FF UART */ SAVE(FFIER); SAVE(FFLCR); SAVE(FFMCR); SAVE(FFSPR); SAVE(FFISR); FFLCR |= 0x80; SAVE(FFDLL); SAVE(FFDLH); FFLCR &= 0xef; /* save vital registers */ SAVE(OSCR); SAVE(OSMR0); SAVE(OSMR1); SAVE(OSMR2); SAVE(OSMR3); SAVE(OIER); SAVE(GPDR0); SAVE(GPDR1); SAVE(GPDR2); SAVE(GRER0); SAVE(GRER1); SAVE(GRER2); SAVE(GFER0); SAVE(GFER1); SAVE(GFER2); SAVE(GAFR0_L); SAVE(GAFR0_U); SAVE(GAFR1_L); SAVE(GAFR1_U); SAVE(GAFR2_L); SAVE(GAFR2_U); SAVE(ICMR); ICMR = 0; SAVE(CKEN); CKEN = 0; /* Note: wake up source are set up in each machine specific files */ /* clear GPIO transition detect bits */ GEDR0 = GEDR0; GEDR1 = GEDR1; GEDR2 = GEDR2; /* Clear sleep reset status */ RCSR = RCSR_SMR; /* set resume return address */ PSPR = virt_to_phys(pxa_cpu_resume); /* before sleeping, calculate and save a checksum */ for (i = 0; i < SLEEP_SAVE_SIZE - 1; i++) checksum += sleep_save[i]; sleep_save[SLEEP_SAVE_CKSUM] = checksum; /* *** go zzz *** */ pxa_cpu_suspend(); /* after sleeping, validate the checksum */ checksum = 0; for (i = 0; i < SLEEP_SAVE_SIZE - 1; i++) checksum += sleep_save[i]; /* if invalid, display message and wait for a hardware reset */ if (checksum != sleep_save[SLEEP_SAVE_CKSUM]) { #ifdef CONFIG_ARCH_LUBBOCK LUB_HEXLED = 0xbadbadc5; #endif while (1); } /* ensure not to come back here if it wasn't intended */ PSPR = 0; /* restore registers */ RESTORE(GPDR0); RESTORE(GPDR1); RESTORE(GPDR2); RESTORE(GRER0); RESTORE(GRER1); RESTORE(GRER2); RESTORE(GFER0); RESTORE(GFER1); RESTORE(GFER2); RESTORE(GAFR0_L); RESTORE(GAFR0_U); RESTORE(GAFR1_L); RESTORE(GAFR1_U); RESTORE(GAFR2_L); RESTORE(GAFR2_U); PSSR = PSSR_PH; RESTORE(OSMR0); RESTORE(OSMR1); RESTORE(OSMR2); RESTORE(OSMR3); RESTORE(OSCR); RESTORE(OIER); RESTORE(CKEN); ICLR = 0; ICCR = 1; RESTORE(ICMR); /* * Temporary solution. This won't be necessary once * we move pxa support into the serial driver. * Restore the FF UART. */ RESTORE(FFMCR); RESTORE(FFSPR); RESTORE(FFLCR); FFLCR |= 0x80; RESTORE(FFDLH); RESTORE(FFDLL); RESTORE(FFLCR); RESTORE(FFISR); FFFCR = 0x07; RESTORE(FFIER); /* restore current time */ xtime.tv_sec = RCNR + delta; #ifdef DEBUG printk(KERN_DEBUG "*** made it back from resume\n"); #endif return 0; }
static int pxa_pm_enter(suspend_state_t state) { unsigned long sleep_save[SLEEP_SAVE_SIZE]; unsigned long checksum = 0; struct timespec delta, rtc; int i; if (state != PM_SUSPEND_MEM) return -EINVAL; #ifdef CONFIG_IWMMXT /* force any iWMMXt context to ram **/ iwmmxt_task_disable(NULL); #endif /* preserve current time */ rtc.tv_sec = RCNR; rtc.tv_nsec = 0; save_time_delta(&delta, &rtc); SAVE(GPLR0); SAVE(GPLR1); SAVE(GPLR2); SAVE(GPDR0); SAVE(GPDR1); SAVE(GPDR2); SAVE(GRER0); SAVE(GRER1); SAVE(GRER2); SAVE(GFER0); SAVE(GFER1); SAVE(GFER2); SAVE(PGSR0); SAVE(PGSR1); SAVE(PGSR2); SAVE(GAFR0_L); SAVE(GAFR0_U); SAVE(GAFR1_L); SAVE(GAFR1_U); SAVE(GAFR2_L); SAVE(GAFR2_U); #ifdef CONFIG_PXA27x SAVE(GPLR3); SAVE(GPDR3); SAVE(GRER3); SAVE(GFER3); SAVE(PGSR3); SAVE(GAFR3_L); SAVE(GAFR3_U); #endif SAVE(ICMR); ICMR = 0; SAVE(CKEN); CKEN = 0; SAVE(PSTR); /* Note: wake up source are set up in each machine specific files */ /* clear GPIO transition detect bits */ GEDR0 = GEDR0; GEDR1 = GEDR1; GEDR2 = GEDR2; #ifdef CONFIG_PXA27x GEDR3 = GEDR3; #endif /* Clear sleep reset status */ RCSR = RCSR_SMR; /* set resume return address */ PSPR = virt_to_phys(pxa_cpu_resume); /* before sleeping, calculate and save a checksum */ for (i = 0; i < SLEEP_SAVE_SIZE - 1; i++) checksum += sleep_save[i]; sleep_save[SLEEP_SAVE_CKSUM] = checksum; /* *** go zzz *** */ pxa_cpu_suspend(); /* after sleeping, validate the checksum */ checksum = 0; for (i = 0; i < SLEEP_SAVE_SIZE - 1; i++) checksum += sleep_save[i]; /* if invalid, display message and wait for a hardware reset */ if (checksum != sleep_save[SLEEP_SAVE_CKSUM]) { #ifdef CONFIG_ARCH_LUBBOCK LUB_HEXLED = 0xbadbadc5; #endif while (1) pxa_cpu_suspend(); } /* ensure not to come back here if it wasn't intended */ PSPR = 0; /* restore registers */ RESTORE(GAFR0_L); RESTORE(GAFR0_U); RESTORE(GAFR1_L); RESTORE(GAFR1_U); RESTORE(GAFR2_L); RESTORE(GAFR2_U); RESTORE_GPLEVEL(0); RESTORE_GPLEVEL(1); RESTORE_GPLEVEL(2); RESTORE(GPDR0); RESTORE(GPDR1); RESTORE(GPDR2); RESTORE(GRER0); RESTORE(GRER1); RESTORE(GRER2); RESTORE(GFER0); RESTORE(GFER1); RESTORE(GFER2); RESTORE(PGSR0); RESTORE(PGSR1); RESTORE(PGSR2); #ifdef CONFIG_PXA27x RESTORE(GAFR3_L); RESTORE(GAFR3_U); RESTORE_GPLEVEL(3); RESTORE(GPDR3); RESTORE(GRER3); RESTORE(GFER3); RESTORE(PGSR3); #endif PSSR = PSSR_RDH | PSSR_PH; RESTORE(CKEN); ICLR = 0; ICCR = 1; RESTORE(ICMR); RESTORE(PSTR); /* restore current time */ rtc.tv_sec = RCNR; restore_time_delta(&delta, &rtc); #ifdef DEBUG printk(KERN_DEBUG "*** made it back from resume\n"); #endif return 0; }