1 files changed, 418 insertions, 0 deletions

diff --git a/arch/blackfin/mach-common/dpmc.S b/arch/blackfin/mach-common/dpmc.S
new file mode 100644
index 000000000000..97cdcd6a00d4
--- /dev/null
+++ b/arch/blackfin/mach-common/dpmc.S
@@ -0,0 +1,418 @@
+/*
+ * File:         arch/blackfin/mach-common/dpmc.S
+ * Based on:
+ * Author:       LG Soft India
+ *
+ * Created:      ?
+ * Description:  Watchdog Timer APIs
+ *
+ * Modified:
+ *               Copyright 2004-2006 Analog Devices Inc.
+ *
+ * Bugs:         Enter bugs at http://blackfin.uclinux.org/
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * 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, see the file COPYING, or write
+ * to the Free Software Foundation, Inc.,
+ * 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
+ */
+
+#include <linux/linkage.h>
+#include <asm/blackfin.h>
+#include <asm/mach/irq.h>
+
+.text
+
+ENTRY(_unmask_wdog_wakeup_evt)
+        [--SP] = ( R7:0, P5:0 );
+#if defined(CONFIG_BF561)
+        P0.H = hi(SICA_IWR1);
+        P0.L = lo(SICA_IWR1);
+#else
+        P0.h = (SIC_IWR >> 16);
+        P0.l = (SIC_IWR & 0xFFFF);
+#endif
+        R7 = [P0];
+#if defined(CONFIG_BF561)
+        BITSET(R7, 27);
+#else
+        BITSET(R7,(IRQ_WATCH - IVG7));
+#endif
+        [P0] = R7;
+        SSYNC;
+
+        ( R7:0, P5:0 ) = [SP++];
+        RTS;
+
+.LWRITE_TO_STAT:
+        /* When watch dog timer is enabled, a write to STAT will load the
+         * contents of CNT to STAT
+         */
+        R7 = 0x0000(z);
+#if defined(CONFIG_BF561)
+        P0.h = (WDOGA_STAT >> 16);
+        P0.l = (WDOGA_STAT & 0xFFFF);
+#else
+        P0.h = (WDOG_STAT >> 16);
+        P0.l = (WDOG_STAT & 0xFFFF);
+#endif
+        [P0] = R7;
+        SSYNC;
+        JUMP .LSKIP_WRITE_TO_STAT;
+
+ENTRY(_program_wdog_timer)
+        [--SP] = ( R7:0, P5:0 );
+#if defined(CONFIG_BF561)
+        P0.h = (WDOGA_CNT >> 16);
+        P0.l = (WDOGA_CNT & 0xFFFF);
+#else
+        P0.h = (WDOG_CNT >> 16);
+        P0.l = (WDOG_CNT & 0xFFFF);
+#endif
+        [P0] = R0;
+        SSYNC;
+
+#if defined(CONFIG_BF561)
+        P0.h = (WDOGA_CTL >> 16);
+        P0.l = (WDOGA_CTL & 0xFFFF);
+#else
+        P0.h = (WDOG_CTL >> 16);
+        P0.l = (WDOG_CTL & 0xFFFF);
+#endif
+        R7 = W[P0](Z);
+        CC = BITTST(R7,1);
+        if !CC JUMP .LWRITE_TO_STAT;
+        CC = BITTST(R7,2);
+        if !CC JUMP .LWRITE_TO_STAT;
+
+.LSKIP_WRITE_TO_STAT:
+#if defined(CONFIG_BF561)
+        P0.h = (WDOGA_CTL >> 16);
+            P0.l = (WDOGA_CTL & 0xFFFF);
+#else
+        P0.h = (WDOG_CTL >> 16);
+            P0.l = (WDOG_CTL & 0xFFFF);
+#endif
+        R7 = W[P0](Z);
+        BITCLR(R7,1);   /* Enable GP event */
+        BITSET(R7,2);
+        W[P0] = R7.L;
+        SSYNC;
+        NOP;
+
+        R7 = W[P0](Z);
+        BITCLR(R7,4);   /* Enable the wdog counter */
+        W[P0] = R7.L;
+        SSYNC;
+
+        ( R7:0, P5:0 ) = [SP++];
+        RTS;
+
+ENTRY(_clear_wdog_wakeup_evt)
+        [--SP] = ( R7:0, P5:0 );
+
+#if defined(CONFIG_BF561)
+        P0.h = (WDOGA_CTL >> 16);
+        P0.l = (WDOGA_CTL & 0xFFFF);
+#else
+        P0.h = (WDOG_CTL >> 16);
+        P0.l = (WDOG_CTL & 0xFFFF);
+#endif
+        R7 = 0x0AD6(Z);
+        W[P0] = R7.L;
+        SSYNC;
+
+        R7 = W[P0](Z);
+        BITSET(R7,15);
+        W[P0] = R7.L;
+        SSYNC;
+
+        R7 = W[P0](Z);
+        BITSET(R7,1);
+        BITSET(R7,2);
+        W[P0] = R7.L;
+        SSYNC;
+
+        ( R7:0, P5:0 ) = [SP++];
+        RTS;
+
+ENTRY(_disable_wdog_timer)
+        [--SP] = ( R7:0, P5:0 );
+#if defined(CONFIG_BF561)
+        P0.h = (WDOGA_CTL >> 16);
+        P0.l = (WDOGA_CTL & 0xFFFF);
+#else
+        P0.h = (WDOG_CTL >> 16);
+        P0.l = (WDOG_CTL & 0xFFFF);
+#endif
+        R7 = 0xAD6(Z);
+        W[P0] = R7.L;
+        SSYNC;
+        ( R7:0, P5:0 ) = [SP++];
+        RTS;
+
+#if !defined(CONFIG_BF561)
+
+.section .l1.text
+
+ENTRY(_sleep_mode)
+        [--SP] = ( R7:0, P5:0 );
+        [--SP] =  RETS;
+
+        call _set_sic_iwr;
+
+        R0 = 0xFFFF (Z);
+        call _set_rtc_istat
+
+        P0.H = hi(PLL_CTL);
+        P0.L = lo(PLL_CTL);
+        R1 = W[P0](z);
+        BITSET (R1, 3);
+        W[P0] = R1.L;
+
+        CLI R2;
+        SSYNC;
+        IDLE;
+        STI R2;
+
+        call _test_pll_locked;
+
+        R0 = IWR_ENABLE(0);
+        call _set_sic_iwr;
+
+        P0.H = hi(PLL_CTL);
+        P0.L = lo(PLL_CTL);
+        R7 = w[p0](z);
+        BITCLR (R7, 3);
+        BITCLR (R7, 5);
+        w[p0] = R7.L;
+        IDLE;
+        call _test_pll_locked;
+
+        RETS = [SP++];
+        ( R7:0, P5:0 ) = [SP++];
+        RTS;
+
+ENTRY(_hibernate_mode)
+        [--SP] = ( R7:0, P5:0 );
+        [--SP] =  RETS;
+
+        call _set_sic_iwr;
+
+        R0 = 0xFFFF (Z);
+        call _set_rtc_istat
+
+        P0.H = hi(VR_CTL);
+        P0.L = lo(VR_CTL);
+        R1 = W[P0](z);
+        BITSET (R1, 8);
+        BITCLR (R1, 0);
+        BITCLR (R1, 1);
+        W[P0] = R1.L;
+        SSYNC;
+
+        CLI R2;
+        IDLE;
+
+        /* Actually, adding anything may not be necessary...SDRAM contents
+         * are lost
+         */
+
+ENTRY(_deep_sleep)
+        [--SP] = ( R7:0, P5:0 );
+        [--SP] =  RETS;
+
+        CLI R4;
+
+        call _set_sic_iwr;
+
+        call _set_sdram_srfs;
+
+        /* Clear all the interrupts,bits sticky */
+        R0 = 0xFFFF (Z);
+        call _set_rtc_istat
+
+        P0.H = hi(PLL_CTL);
+        P0.L = lo(PLL_CTL);
+        R0 = W[P0](z);
+        BITSET (R0, 5);
+        W[P0] = R0.L;
+
+        call _test_pll_locked;
+
+        SSYNC;
+        IDLE;
+
+        call _unset_sdram_srfs;
+
+        call _test_pll_locked;
+
+        R0 = IWR_ENABLE(0);
+        call _set_sic_iwr;
+
+        P0.H = hi(PLL_CTL);
+        P0.L = lo(PLL_CTL);
+        R0 = w[p0](z);
+        BITCLR (R0, 3);
+        BITCLR (R0, 5);
+        BITCLR (R0, 8);
+        w[p0] = R0;
+        IDLE;
+        call _test_pll_locked;
+
+        STI R4;
+
+        RETS = [SP++];
+        ( R7:0, P5:0 ) = [SP++];
+        RTS;
+
+ENTRY(_sleep_deeper)
+        [--SP] = ( R7:0, P5:0 );
+        [--SP] =  RETS;
+
+        CLI R4;
+
+        P3 = R0;
+        R0 = IWR_ENABLE(0);
+        call _set_sic_iwr;
+        call _set_sdram_srfs;
+
+        /* Clear all the interrupts,bits sticky */
+        R0 = 0xFFFF (Z);
+        call _set_rtc_istat
+
+        P0.H = hi(PLL_DIV);
+        P0.L = lo(PLL_DIV);
+        R6 = W[P0](z);
+        R0.L = 0xF;
+        W[P0] = R0.l;
+
+        P0.H = hi(PLL_CTL);
+        P0.L = lo(PLL_CTL);
+        R5 = W[P0](z);
+        R0.L = (MIN_VC/CONFIG_CLKIN_HZ) << 9;
+        W[P0] = R0.l;
+
+        SSYNC;
+        IDLE;
+
+        call _test_pll_locked;
+
+        P0.H = hi(VR_CTL);
+        P0.L = lo(VR_CTL);
+        R7 = W[P0](z);
+        R1 = 0x6;
+        R1 <<= 16;
+        R2 = 0x0404(Z);
+        R1 = R1|R2;
+
+        R2 = DEPOSIT(R7, R1);
+        W[P0] = R2;
+
+        SSYNC;
+        IDLE;
+
+        call _test_pll_locked;
+
+        P0.H = hi(PLL_CTL);
+        P0.L = lo(PLL_CTL);
+        R0 = W[P0](z);
+        BITSET (R0, 3);
+        W[P0] = R0.L;
+
+        R0 = P3;
+        call _set_sic_iwr;
+
+        SSYNC;
+        IDLE;
+
+        call _test_pll_locked;
+
+        R0 = IWR_ENABLE(0);
+        call _set_sic_iwr;
+
+        P0.H = hi(VR_CTL);
+        P0.L = lo(VR_CTL);
+        W[P0]= R7;
+
+        SSYNC;
+        IDLE;
+
+        call _test_pll_locked;
+
+        P0.H = hi(PLL_DIV);
+        P0.L = lo(PLL_DIV);
+        W[P0]= R6;
+
+        P0.H = hi(PLL_CTL);
+        P0.L = lo(PLL_CTL);
+        w[p0] = R5;
+        IDLE;
+        call _test_pll_locked;
+
+        call _unset_sdram_srfs;
+
+        STI R4;
+
+        RETS = [SP++];
+        ( R7:0, P5:0 ) = [SP++];
+        RTS;
+
+ENTRY(_set_sdram_srfs)
+        /*  set the sdram to self refresh mode */
+        P0.H = hi(EBIU_SDGCTL);
+        P0.L = lo(EBIU_SDGCTL);
+        R2 = [P0];
+        R3.H = hi(SRFS);
+        R3.L = lo(SRFS);
+        R2 = R2|R3;
+        [P0] = R2;
+        ssync;
+        RTS;
+
+ENTRY(_unset_sdram_srfs)
+        /*  set the sdram out of self refresh mode */
+        P0.H = hi(EBIU_SDGCTL);
+        P0.L = lo(EBIU_SDGCTL);
+        R2 = [P0];
+        R3.H = hi(SRFS);
+        R3.L = lo(SRFS);
+        R3 = ~R3;
+        R2 = R2&R3;
+        [P0] = R2;
+        ssync;
+        RTS;
+
+ENTRY(_set_sic_iwr)
+        P0.H = hi(SIC_IWR);
+        P0.L = lo(SIC_IWR);
+        [P0] = R0;
+        SSYNC;
+        RTS;
+
+ENTRY(_set_rtc_istat)
+        P0.H = hi(RTC_ISTAT);
+        P0.L = lo(RTC_ISTAT);
+        w[P0] = R0.L;
+        SSYNC;
+        RTS;
+
+ENTRY(_test_pll_locked)
+        P0.H = hi(PLL_STAT);
+        P0.L = lo(PLL_STAT);
+1:
+        R0 = W[P0] (Z);
+        CC = BITTST(R0,5);
+        IF !CC JUMP 1b;
+        RTS;
+#endif