2 * Copyright 2004-2008 Analog Devices Inc.
4 * Licensed under the GPL-2 or later.
7 #include <linux/linkage.h>
8 #include <asm/blackfin.h>
15 [--SP] = ( R7:0, P5:0 );
31 call _test_pll_locked;
46 call _test_pll_locked;
49 ( R7:0, P5:0 ) = [SP++];
53 ENTRY(_hibernate_mode)
54 [--SP] = ( R7:0, P5:0 );
73 ENDPROC(_hibernate_mode)
76 [--SP] = ( R7:0, P5:0 );
90 call _set_dram_srfs; /* Set SDRAM Self Refresh */
96 W[P0] = R0.l; /* Set Max VCO to SCLK divider */
101 R0.L = (CONFIG_MIN_VCO_HZ/CONFIG_CLKIN_HZ) << 9;
102 W[P0] = R0.l; /* Set Min CLKIN to VCO multiplier */
107 call _test_pll_locked;
117 R2 = DEPOSIT(R7, R1);
118 W[P0] = R2; /* Set Min Core Voltage */
123 call _test_pll_locked;
128 call _set_sic_iwr; /* Set Awake from IDLE */
134 W[P0] = R0.L; /* Turn CCLK OFF */
138 call _test_pll_locked;
141 R1 = IWR_DISABLE_ALL;
142 R2 = IWR_DISABLE_ALL;
144 call _set_sic_iwr; /* Set Awake from IDLE PLL */
153 call _test_pll_locked;
157 W[P0]= R6; /* Restore CCLK and SCLK divider */
161 w[p0] = R5; /* Restore VCO multiplier */
163 call _test_pll_locked;
165 call _unset_dram_srfs; /* SDRAM Self Refresh Off */
170 ( R7:0, P5:0 ) = [SP++];
172 ENDPROC(_sleep_deeper)
174 ENTRY(_set_dram_srfs)
175 /* set the dram to self refresh mode */
177 #if defined(EBIU_RSTCTL) /* DDR */
178 P0.H = hi(EBIU_RSTCTL);
179 P0.L = lo(EBIU_RSTCTL);
181 BITSET(R2, 3); /* SRREQ enter self-refresh mode */
189 P0.L = lo(EBIU_SDGCTL);
190 P0.H = hi(EBIU_SDGCTL);
192 BITSET(R2, 24); /* SRFS enter self-refresh mode */
196 P0.L = lo(EBIU_SDSTAT);
197 P0.H = hi(EBIU_SDSTAT);
201 cc = BITTST(R2, 1); /* SDSRA poll self-refresh status */
204 P0.L = lo(EBIU_SDGCTL);
205 P0.H = hi(EBIU_SDGCTL);
207 BITCLR(R2, 0); /* SCTLE disable CLKOUT */
211 ENDPROC(_set_dram_srfs)
213 ENTRY(_unset_dram_srfs)
214 /* set the dram out of self refresh mode */
215 #if defined(EBIU_RSTCTL) /* DDR */
216 P0.H = hi(EBIU_RSTCTL);
217 P0.L = lo(EBIU_RSTCTL);
219 BITCLR(R2, 3); /* clear SRREQ bit */
221 #elif defined(EBIU_SDGCTL) /* SDRAM */
223 P0.L = lo(EBIU_SDGCTL); /* release CLKOUT from self-refresh */
224 P0.H = hi(EBIU_SDGCTL);
226 BITSET(R2, 0); /* SCTLE enable CLKOUT */
230 P0.L = lo(EBIU_SDGCTL); /* release SDRAM from self-refresh */
231 P0.H = hi(EBIU_SDGCTL);
233 BITCLR(R2, 24); /* clear SRFS bit */
238 ENDPROC(_unset_dram_srfs)
242 P0.H = hi(SYSMMR_BASE);
243 P0.L = lo(SYSMMR_BASE);
244 [P0 + (SIC_IWR0 - SYSMMR_BASE)] = R0;
245 [P0 + (SIC_IWR1 - SYSMMR_BASE)] = R1;
247 [P0 + (SIC_IWR2 - SYSMMR_BASE)] = R2;
257 ENDPROC(_set_sic_iwr)
259 ENTRY(_test_pll_locked)
267 ENDPROC(_test_pll_locked)
272 [--SP] = ( R7:0, P5:0 );
274 /* Save System MMRs */
280 PM_SYS_PUSH(SIC_IMASK0)
283 PM_SYS_PUSH(SIC_IMASK1)
286 PM_SYS_PUSH(SIC_IMASK2)
289 PM_SYS_PUSH(SIC_IMASK)
292 PM_SYS_PUSH(SIC_IAR0)
293 PM_SYS_PUSH(SIC_IAR1)
294 PM_SYS_PUSH(SIC_IAR2)
297 PM_SYS_PUSH(SIC_IAR3)
300 PM_SYS_PUSH(SIC_IAR4)
301 PM_SYS_PUSH(SIC_IAR5)
302 PM_SYS_PUSH(SIC_IAR6)
305 PM_SYS_PUSH(SIC_IAR7)
308 PM_SYS_PUSH(SIC_IAR8)
309 PM_SYS_PUSH(SIC_IAR9)
310 PM_SYS_PUSH(SIC_IAR10)
311 PM_SYS_PUSH(SIC_IAR11)
318 PM_SYS_PUSH(SIC_IWR0)
321 PM_SYS_PUSH(SIC_IWR1)
324 PM_SYS_PUSH(SIC_IWR2)
328 PM_SYS_PUSH(PINT0_MASK_SET)
329 PM_SYS_PUSH(PINT1_MASK_SET)
330 PM_SYS_PUSH(PINT2_MASK_SET)
331 PM_SYS_PUSH(PINT3_MASK_SET)
332 PM_SYS_PUSH(PINT0_ASSIGN)
333 PM_SYS_PUSH(PINT1_ASSIGN)
334 PM_SYS_PUSH(PINT2_ASSIGN)
335 PM_SYS_PUSH(PINT3_ASSIGN)
336 PM_SYS_PUSH(PINT0_INVERT_SET)
337 PM_SYS_PUSH(PINT1_INVERT_SET)
338 PM_SYS_PUSH(PINT2_INVERT_SET)
339 PM_SYS_PUSH(PINT3_INVERT_SET)
340 PM_SYS_PUSH(PINT0_EDGE_SET)
341 PM_SYS_PUSH(PINT1_EDGE_SET)
342 PM_SYS_PUSH(PINT2_EDGE_SET)
343 PM_SYS_PUSH(PINT3_EDGE_SET)
346 PM_SYS_PUSH(EBIU_AMBCTL0)
347 PM_SYS_PUSH(EBIU_AMBCTL1)
348 PM_SYS_PUSH16(EBIU_AMGCTL)
351 PM_SYS_PUSH(EBIU_MBSCTL)
352 PM_SYS_PUSH(EBIU_MODE)
353 PM_SYS_PUSH(EBIU_FCTL)
357 PM_SYS_PUSH16(PORTCIO_DIR)
358 PM_SYS_PUSH16(PORTCIO_INEN)
359 PM_SYS_PUSH16(PORTCIO)
360 PM_SYS_PUSH16(PORTCIO_FER)
361 PM_SYS_PUSH16(PORTDIO_DIR)
362 PM_SYS_PUSH16(PORTDIO_INEN)
363 PM_SYS_PUSH16(PORTDIO)
364 PM_SYS_PUSH16(PORTDIO_FER)
365 PM_SYS_PUSH16(PORTEIO_DIR)
366 PM_SYS_PUSH16(PORTEIO_INEN)
367 PM_SYS_PUSH16(PORTEIO)
368 PM_SYS_PUSH16(PORTEIO_FER)
374 P0.H = hi(SRAM_BASE_ADDRESS);
375 P0.L = lo(SRAM_BASE_ADDRESS);
377 PM_PUSH(DMEM_CONTROL)
388 PM_PUSH(DCPLB_ADDR10)
389 PM_PUSH(DCPLB_ADDR11)
390 PM_PUSH(DCPLB_ADDR12)
391 PM_PUSH(DCPLB_ADDR13)
392 PM_PUSH(DCPLB_ADDR14)
393 PM_PUSH(DCPLB_ADDR15)
404 PM_PUSH(DCPLB_DATA10)
405 PM_PUSH(DCPLB_DATA11)
406 PM_PUSH(DCPLB_DATA12)
407 PM_PUSH(DCPLB_DATA13)
408 PM_PUSH(DCPLB_DATA14)
409 PM_PUSH(DCPLB_DATA15)
410 PM_PUSH(IMEM_CONTROL)
421 PM_PUSH(ICPLB_ADDR10)
422 PM_PUSH(ICPLB_ADDR11)
423 PM_PUSH(ICPLB_ADDR12)
424 PM_PUSH(ICPLB_ADDR13)
425 PM_PUSH(ICPLB_ADDR14)
426 PM_PUSH(ICPLB_ADDR15)
437 PM_PUSH(ICPLB_DATA10)
438 PM_PUSH(ICPLB_DATA11)
439 PM_PUSH(ICPLB_DATA12)
440 PM_PUSH(ICPLB_DATA13)
441 PM_PUSH(ICPLB_DATA14)
442 PM_PUSH(ICPLB_DATA15)
468 /* Save Core Registers */
470 [--sp] = ( R7:0, P5:0 );
517 /* Save Magic, return address and Stack Pointer */
520 R0.H = 0xDEAD; /* Hibernate Magic */
522 [P0++] = R0; /* Store Hibernate Magic */
523 R0.H = .Lpm_resume_here;
524 R0.L = .Lpm_resume_here;
525 [P0++] = R0; /* Save Return Address */
526 [P0++] = SP; /* Save Stack Pointer */
527 P0.H = _hibernate_mode;
528 P0.L = _hibernate_mode;
530 call (P0); /* Goodbye */
534 /* Restore Core Registers */
581 ( R7 : 0, P5 : 0) = [ SP ++ ];
584 /* Restore Core MMRs */
677 /* Restore System MMRs */
684 PM_SYS_POP16(PORTEIO_FER)
685 PM_SYS_POP16(PORTEIO)
686 PM_SYS_POP16(PORTEIO_INEN)
687 PM_SYS_POP16(PORTEIO_DIR)
688 PM_SYS_POP16(PORTDIO_FER)
689 PM_SYS_POP16(PORTDIO)
690 PM_SYS_POP16(PORTDIO_INEN)
691 PM_SYS_POP16(PORTDIO_DIR)
692 PM_SYS_POP16(PORTCIO_FER)
693 PM_SYS_POP16(PORTCIO)
694 PM_SYS_POP16(PORTCIO_INEN)
695 PM_SYS_POP16(PORTCIO_DIR)
699 PM_SYS_POP(EBIU_FCTL)
700 PM_SYS_POP(EBIU_MODE)
701 PM_SYS_POP(EBIU_MBSCTL)
703 PM_SYS_POP16(EBIU_AMGCTL)
704 PM_SYS_POP(EBIU_AMBCTL1)
705 PM_SYS_POP(EBIU_AMBCTL0)
708 PM_SYS_POP(PINT3_EDGE_SET)
709 PM_SYS_POP(PINT2_EDGE_SET)
710 PM_SYS_POP(PINT1_EDGE_SET)
711 PM_SYS_POP(PINT0_EDGE_SET)
712 PM_SYS_POP(PINT3_INVERT_SET)
713 PM_SYS_POP(PINT2_INVERT_SET)
714 PM_SYS_POP(PINT1_INVERT_SET)
715 PM_SYS_POP(PINT0_INVERT_SET)
716 PM_SYS_POP(PINT3_ASSIGN)
717 PM_SYS_POP(PINT2_ASSIGN)
718 PM_SYS_POP(PINT1_ASSIGN)
719 PM_SYS_POP(PINT0_ASSIGN)
720 PM_SYS_POP(PINT3_MASK_SET)
721 PM_SYS_POP(PINT2_MASK_SET)
722 PM_SYS_POP(PINT1_MASK_SET)
723 PM_SYS_POP(PINT0_MASK_SET)
740 PM_SYS_POP(SIC_IAR11)
741 PM_SYS_POP(SIC_IAR10)
762 PM_SYS_POP(SIC_IMASK)
765 PM_SYS_POP(SIC_IMASK2)
768 PM_SYS_POP(SIC_IMASK1)
771 PM_SYS_POP(SIC_IMASK0)
774 [--sp] = RETI; /* Clear Global Interrupt Disable */
778 ( R7:0, P5:0 ) = [SP++];
780 ENDPROC(_do_hibernate)