Subversion Repositories openrisc_2011-10-31

/* Support functions for the unwinder.

   Copyright (C) 2003, 2004, 2005, 2007, 2008, 2009  Free Software Foundation, Inc.

   Contributed by Paul Brook

   This file 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 3, or (at your option) any

   later version.

   This file 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.

   Under Section 7 of GPL version 3, you are granted additional

   permissions described in the GCC Runtime Library Exception, version

   3.1, as published by the Free Software Foundation.

   You should have received a copy of the GNU General Public License and

   a copy of the GCC Runtime Library Exception along with this program;

   see the files COPYING3 and COPYING.RUNTIME respectively.  If not, see

   .  */

/* An executable stack is *not* required for these functions.  */

#if defined(__ELF__) && defined(__linux__)

.section .note.GNU-stack,"",%progbits

.previous

#endif

#ifndef __symbian__

#include "lib1funcs.asm"

.macro UNPREFIX name

        .global SYM (\name)

        EQUIV SYM (\name), SYM (__\name)

.endm

#if (__ARM_ARCH__ == 4)

/* Some coprocessors require armv5.  We know this code will never be run on

   other cpus.  Tell gas to allow armv5, but only mark the objects as armv4.

 */

.arch armv5t

#ifdef __ARM_ARCH_4T__

.object_arch armv4t

#else

.object_arch armv4

#endif

#endif

#ifdef __ARM_ARCH_6M__

/* r0 points to a 16-word block.  Upload these values to the actual core

   state.  */

FUNC_START restore_core_regs

        mov r1, r0

        add r1, r1, #52

        ldmia r1!, {r3, r4, r5}

        sub r3, r3, #4

        mov ip, r3

        str r5, [r3]

        mov lr, r4

        /* Restore r8-r11.  */

        mov r1, r0

        add r1, r1, #32

        ldmia r1!, {r2, r3, r4, r5}

        mov r8, r2

        mov r9, r3

        mov sl, r4

        mov fp, r5

        mov r1, r0

        add r1, r1, #8

        ldmia r1!, {r2, r3, r4, r5, r6, r7}

        ldr r1, [r0, #4]

        ldr r0, [r0]

        mov sp, ip

        pop {pc}

        FUNC_END restore_core_regs

        UNPREFIX restore_core_regs

/* ARMV6M does not have coprocessors, so these should never be used.  */

FUNC_START gnu_Unwind_Restore_VFP

        RET

/* Store VFR regsters d0-d15 to the address in r0.  */

FUNC_START gnu_Unwind_Save_VFP

        RET

/* Load VFP registers d0-d15 from the address in r0.

   Use this to load from FSTMD format.  */

FUNC_START gnu_Unwind_Restore_VFP_D

        RET

/* Store VFP registers d0-d15 to the address in r0.

   Use this to store in FLDMD format.  */

FUNC_START gnu_Unwind_Save_VFP_D

        RET

/* Load VFP registers d16-d31 from the address in r0.

   Use this to load from FSTMD (=VSTM) format.  Needs VFPv3.  */

FUNC_START gnu_Unwind_Restore_VFP_D_16_to_31

        RET

/* Store VFP registers d16-d31 to the address in r0.

   Use this to store in FLDMD (=VLDM) format.  Needs VFPv3.  */

FUNC_START gnu_Unwind_Save_VFP_D_16_to_31

        RET

FUNC_START gnu_Unwind_Restore_WMMXD

        RET

FUNC_START gnu_Unwind_Save_WMMXD

        RET

FUNC_START gnu_Unwind_Restore_WMMXC

        RET

FUNC_START gnu_Unwind_Save_WMMXC

        RET

.macro  UNWIND_WRAPPER name nargs

        FUNC_START \name

        /* Create a phase2_vrs structure.  */

        /* Save r0 in the PC slot so we can use it as a scratch register.  */

        push {r0}

        add r0, sp, #4

        push {r0, lr} /* Push original SP and LR.  */

        /* Make space for r8-r12.  */

        sub sp, sp, #20

        /* Save low registers.  */

        push {r0, r1, r2, r3, r4, r5, r6, r7}

        /* Save high registers.  */

        add r0, sp, #32

        mov r1, r8

        mov r2, r9

        mov r3, sl

        mov r4, fp

        mov r5, ip

        stmia r0!, {r1, r2, r3, r4, r5}

        /* Restore original low register values.  */

        add r0, sp, #4

        ldmia r0!, {r1, r2, r3, r4, r5}

        /* Restore orginial r0.  */

        ldr r0, [sp, #60]

        str r0, [sp]

        /* Demand-save flags, plus an extra word for alignment.  */

        mov r3, #0

        push {r2, r3}

        /* Point r1 at the block.  Pass r[0..nargs) unchanged.  */

        add r\nargs, sp, #4

        bl SYM (__gnu\name)

        ldr r3, [sp, #64]

        add sp, sp, #72

        bx r3

        FUNC_END \name

        UNPREFIX \name

.endm

#else /* !__ARM_ARCH_6M__ */

/* r0 points to a 16-word block.  Upload these values to the actual core

   state.  */

ARM_FUNC_START restore_core_regs

        /* We must use sp as the base register when restoring sp.  Push the

           last 3 registers onto the top of the current stack to achieve

           this.  */

        add r1, r0, #52

        ldmia r1, {r3, r4, r5}  /* {sp, lr, pc}.  */

#if defined(__thumb2__)

        /* Thumb-2 doesn't allow sp in a load-multiple instruction, so push

           the target address onto the target stack.  This is safe as

           we're always returning to somewhere further up the call stack.  */

        mov ip, r3

        mov lr, r4

        str r5, [ip, #-4]!

#elif defined(__INTERWORKING__)

        /* Restore pc into ip.  */

        mov r2, r5

        stmfd sp!, {r2, r3, r4}

#else

        stmfd sp!, {r3, r4, r5}

#endif

        /* Don't bother restoring ip.  */

        ldmia r0, {r0, r1, r2, r3, r4, r5, r6, r7, r8, r9, sl, fp}

#if defined(__thumb2__)

        /* Pop the return address off the target stack.  */

        mov sp, ip

        pop {pc}

#elif defined(__INTERWORKING__)

        /* Pop the three registers we pushed earlier.  */

        ldmfd sp, {ip, sp, lr}

        bx ip

#else

        ldmfd sp, {sp, lr, pc}

#endif

        FUNC_END restore_core_regs

        UNPREFIX restore_core_regs

/* Load VFP registers d0-d15 from the address in r0.

   Use this to load from FSTMX format.  */

ARM_FUNC_START gnu_Unwind_Restore_VFP

        /* Use the generic coprocessor form so that gas doesn't complain

           on soft-float targets.  */

        ldc   p11,cr0,[r0],{0x21} /* fldmiax r0, {d0-d15} */

        RET

/* Store VFP registers d0-d15 to the address in r0.

   Use this to store in FSTMX format.  */

ARM_FUNC_START gnu_Unwind_Save_VFP

        /* Use the generic coprocessor form so that gas doesn't complain

           on soft-float targets.  */

        stc   p11,cr0,[r0],{0x21} /* fstmiax r0, {d0-d15} */

        RET

/* Load VFP registers d0-d15 from the address in r0.

   Use this to load from FSTMD format.  */

ARM_FUNC_START gnu_Unwind_Restore_VFP_D

        ldc   p11,cr0,[r0],{0x20} /* fldmiad r0, {d0-d15} */

        RET

/* Store VFP registers d0-d15 to the address in r0.

   Use this to store in FLDMD format.  */

ARM_FUNC_START gnu_Unwind_Save_VFP_D

        stc   p11,cr0,[r0],{0x20} /* fstmiad r0, {d0-d15} */

        RET

/* Load VFP registers d16-d31 from the address in r0.

   Use this to load from FSTMD (=VSTM) format.  Needs VFPv3.  */

ARM_FUNC_START gnu_Unwind_Restore_VFP_D_16_to_31

        ldcl  p11,cr0,[r0],{0x20} /* vldm r0, {d16-d31} */

        RET

/* Store VFP registers d16-d31 to the address in r0.

   Use this to store in FLDMD (=VLDM) format.  Needs VFPv3.  */

ARM_FUNC_START gnu_Unwind_Save_VFP_D_16_to_31

        stcl  p11,cr0,[r0],{0x20} /* vstm r0, {d16-d31} */

        RET

ARM_FUNC_START gnu_Unwind_Restore_WMMXD

        /* Use the generic coprocessor form so that gas doesn't complain

           on non-iWMMXt targets.  */

        ldcl  p1, cr0, [r0], #8 /* wldrd wr0, [r0], #8 */

        ldcl  p1, cr1, [r0], #8 /* wldrd wr1, [r0], #8 */

        ldcl  p1, cr2, [r0], #8 /* wldrd wr2, [r0], #8 */

        ldcl  p1, cr3, [r0], #8 /* wldrd wr3, [r0], #8 */

        ldcl  p1, cr4, [r0], #8 /* wldrd wr4, [r0], #8 */

        ldcl  p1, cr5, [r0], #8 /* wldrd wr5, [r0], #8 */

        ldcl  p1, cr6, [r0], #8 /* wldrd wr6, [r0], #8 */

        ldcl  p1, cr7, [r0], #8 /* wldrd wr7, [r0], #8 */

        ldcl  p1, cr8, [r0], #8 /* wldrd wr8, [r0], #8 */

        ldcl  p1, cr9, [r0], #8 /* wldrd wr9, [r0], #8 */

        ldcl  p1, cr10, [r0], #8 /* wldrd wr10, [r0], #8 */

        ldcl  p1, cr11, [r0], #8 /* wldrd wr11, [r0], #8 */

        ldcl  p1, cr12, [r0], #8 /* wldrd wr12, [r0], #8 */

        ldcl  p1, cr13, [r0], #8 /* wldrd wr13, [r0], #8 */

        ldcl  p1, cr14, [r0], #8 /* wldrd wr14, [r0], #8 */

        ldcl  p1, cr15, [r0], #8 /* wldrd wr15, [r0], #8 */

        RET

ARM_FUNC_START gnu_Unwind_Save_WMMXD

        /* Use the generic coprocessor form so that gas doesn't complain

           on non-iWMMXt targets.  */

        stcl  p1, cr0, [r0], #8 /* wstrd wr0, [r0], #8 */

        stcl  p1, cr1, [r0], #8 /* wstrd wr1, [r0], #8 */

        stcl  p1, cr2, [r0], #8 /* wstrd wr2, [r0], #8 */

        stcl  p1, cr3, [r0], #8 /* wstrd wr3, [r0], #8 */

        stcl  p1, cr4, [r0], #8 /* wstrd wr4, [r0], #8 */

        stcl  p1, cr5, [r0], #8 /* wstrd wr5, [r0], #8 */

        stcl  p1, cr6, [r0], #8 /* wstrd wr6, [r0], #8 */

        stcl  p1, cr7, [r0], #8 /* wstrd wr7, [r0], #8 */

        stcl  p1, cr8, [r0], #8 /* wstrd wr8, [r0], #8 */

        stcl  p1, cr9, [r0], #8 /* wstrd wr9, [r0], #8 */

        stcl  p1, cr10, [r0], #8 /* wstrd wr10, [r0], #8 */

        stcl  p1, cr11, [r0], #8 /* wstrd wr11, [r0], #8 */

        stcl  p1, cr12, [r0], #8 /* wstrd wr12, [r0], #8 */

        stcl  p1, cr13, [r0], #8 /* wstrd wr13, [r0], #8 */

        stcl  p1, cr14, [r0], #8 /* wstrd wr14, [r0], #8 */

        stcl  p1, cr15, [r0], #8 /* wstrd wr15, [r0], #8 */

        RET

ARM_FUNC_START gnu_Unwind_Restore_WMMXC

        /* Use the generic coprocessor form so that gas doesn't complain

           on non-iWMMXt targets.  */

        ldc2  p1, cr8, [r0], #4 /* wldrw wcgr0, [r0], #4 */

        ldc2  p1, cr9, [r0], #4 /* wldrw wcgr1, [r0], #4 */

        ldc2  p1, cr10, [r0], #4 /* wldrw wcgr2, [r0], #4 */

        ldc2  p1, cr11, [r0], #4 /* wldrw wcgr3, [r0], #4 */

        RET

ARM_FUNC_START gnu_Unwind_Save_WMMXC

        /* Use the generic coprocessor form so that gas doesn't complain

           on non-iWMMXt targets.  */

        stc2  p1, cr8, [r0], #4 /* wstrw wcgr0, [r0], #4 */

        stc2  p1, cr9, [r0], #4 /* wstrw wcgr1, [r0], #4 */

        stc2  p1, cr10, [r0], #4 /* wstrw wcgr2, [r0], #4 */

        stc2  p1, cr11, [r0], #4 /* wstrw wcgr3, [r0], #4 */

        RET

/* Wrappers to save core registers, then call the real routine.   */

.macro  UNWIND_WRAPPER name nargs

        ARM_FUNC_START \name

        /* Create a phase2_vrs structure.  */

        /* Split reg push in two to ensure the correct value for sp.  */

#if defined(__thumb2__)

        mov ip, sp

        push {lr} /* PC is ignored.  */

        push {ip, lr} /* Push original SP and LR.  */

#else

        stmfd sp!, {sp, lr, pc}

#endif

        stmfd sp!, {r0, r1, r2, r3, r4, r5, r6, r7, r8, r9, sl, fp, ip}

        /* Demand-save flags, plus an extra word for alignment.  */

        mov r3, #0

        stmfd sp!, {r2, r3}

        /* Point r1 at the block.  Pass r[0..nargs) unchanged.  */

        add r\nargs, sp, #4

#if defined(__thumb__) && !defined(__thumb2__)

        /* Switch back to thumb mode to avoid interworking hassle.  */

        adr ip, .L1_\name

        orr ip, ip, #1

        bx ip

        .thumb

.L1_\name:

        bl SYM (__gnu\name) __PLT__

        ldr r3, [sp, #64]

        add sp, #72

        bx r3

#else

        bl SYM (__gnu\name) __PLT__

        ldr lr, [sp, #64]

        add sp, sp, #72

        RET

#endif

        FUNC_END \name

        UNPREFIX \name

.endm

#endif /* !__ARM_ARCH_6M__ */

UNWIND_WRAPPER _Unwind_RaiseException 1

UNWIND_WRAPPER _Unwind_Resume 1

UNWIND_WRAPPER _Unwind_Resume_or_Rethrow 1

UNWIND_WRAPPER _Unwind_ForcedUnwind 3

UNWIND_WRAPPER _Unwind_Backtrace 2

#endif  /* ndef __symbian__ */