ref: b548687a8ed1d0a159c9d3f3f921d93bbb56908e
dir: /os/sa1110/suspend.c/
#include "u.h" #include "../port/lib.h" #include "mem.h" #include "dat.h" #include "fns.h" #include "io.h" #include "ureg.h" /* * Originally written by nemo@gsyc.escet.urjc.es, and * reworked by forsyth@vitanuova.com */ enum { DEBUG = 0, }; /* * TO DO: pcmcia, lcd properly */ /* * it's not clear yet whether we should do it this way, * or using powerenable/powerdisable */ void chandevpower(int up) { int i; if(up){ for(i=0; devtab[i] != nil; i++) if(devtab[i]->power != nil) devtab[i]->power(1); }else{ /* power down in reverse order */ for(i=0; devtab[i] != nil; i++) ; while(--i >= 0) if(devtab[i]->power != nil) devtab[i]->power(0); } } static void dumpitall(void) { iprint("intr: icip %lux iclr %lux iccr %lux icmr %lux\n", INTRREG->icip, INTRREG->iclr, INTRREG->iccr, INTRREG->icmr ); iprint("gpio: lvl %lux dir %lux, re %lux, fe %lux sts %lux alt %lux\n", GPIOREG->gplr, GPIOREG->gpdr, GPIOREG->grer, GPIOREG->gfer, GPIOREG->gpsr, GPIOREG->gafr); iprint("uart1: %lux %lux %lux\nuart3: %lux %lux %lux\n", UARTREG(1)->utcr0, UARTREG(1)->utsr0, UARTREG(1)->utsr1, UARTREG(3)->utcr0, UARTREG(3)->utsr0, UARTREG(3)->utsr1); iprint("tmr: osmr %lux %lux %lux %lux oscr %lux ossr %lux oier %lux\n", OSTMRREG->osmr[0], OSTMRREG->osmr[1], OSTMRREG->osmr[2], OSTMRREG->osmr[3], OSTMRREG->oscr, OSTMRREG->ossr, OSTMRREG->oier); iprint("dram: mdcnfg %lux mdrefr %lux cas %lux %lux %lux %lux %lux %lux\n", MEMCFGREG->mdcnfg, MEMCFGREG->mdrefr, MEMCFGREG->mdcas0[0], MEMCFGREG->mdcas0[1],MEMCFGREG->mdcas0[2], MEMCFGREG->mdcas2[0], MEMCFGREG->mdcas2[1],MEMCFGREG->mdcas2[2]); iprint("dram: mdcnfg msc %lux %lux %lux mecr %lux\n", MEMCFGREG->msc0, MEMCFGREG->msc1,MEMCFGREG->msc2, MEMCFGREG->mecr); } static ulong *coreregs[] = { /* can't trust the bootstrap to put these back */ &MEMCFGREG->mecr, &MEMCFGREG->msc0, &MEMCFGREG->msc1, &MEMCFGREG->msc2, &PPCREG->ppdr, &PPCREG->ppsr, /* should save? */ &PPCREG->ppar, &PPCREG->psdr, &GPIOREG->grer, &GPIOREG->gfer, &GPIOREG->gafr, &GPIOREG->gpdr, /* gplr handled specially */ &GPCLKREG->gpclkr1, &GPCLKREG->gpclkr2, &GPCLKREG->gpclkr0, &OSTMRREG->osmr[0], &OSTMRREG->osmr[1], &OSTMRREG->osmr[2], &OSTMRREG->osmr[3], &OSTMRREG->oscr, &OSTMRREG->oier, /* skip ower */ &INTRREG->iclr, &INTRREG->iccr, &INTRREG->icmr, /* interrupts enabled */ nil, }; static ulong corestate[nelem(coreregs)]; void powersuspend(void) { extern void suspenditall(void); GpioReg *g; ulong back = 0x43219990; /* check that the stack's right */ ulong pwer, gplr; ulong *rp; int i, s; s = splfhi(); archpowerdown(); /* sets PMGR and PPC appropriately */ if(DEBUG) dumpitall(); blankscreen(1); chandevpower(0); gplr = GPIOREG->gplr; for(i=0; (rp = coreregs[i]) != nil; i++) corestate[i] = *rp; pwer = PMGRREG->pwer; if(pwer == 0) pwer = 1<<0; g = GPIOREG; g->grer &= pwer; /* just the ones archpowerdown requested */ g->gfer &= pwer; g->gedr = g->gedr; RESETREG->rcsr = 0xF; /* reset all status */ minidcflush(); if(DEBUG) iprint("suspenditall...\n"); suspenditall(); /* keep us in suspense */ PMGRREG->pspr = 0; archpowerup(); trapstacks(); /* set output latches before gpdr restored */ GPIOREG->gpsr = gplr; GPIOREG->gpcr = ~gplr; for(i=0; (rp = coreregs[i]) != nil; i++) *rp = corestate[i]; GPIOREG->gedr = GPIOREG->gedr; /* reset GPIO interrupts (should we?) */ PMGRREG->pssr = PSSR_ph; /* cancel peripheral hold */ chandevpower(1); if(back != 0x43219990){ iprint("back %8.8lux\n", back); panic("powersuspend"); } blankscreen(0); if(DEBUG) dumpitall(); splx(s); }