Subversion Repositories openrisc_me

/*  Special support for trampolines

 *

 *   Copyright (C) 1996, 1997, 2000, 2007, 2008, 2009 Free Software Foundation, Inc.

 *   Written By Michael Meissner

 *

 * 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

 * .

 */

/* Set up trampolines.  */

        .section ".text"

#include "ppc-asm.h"

#include "config.h"

#ifndef __powerpc64__

        .type   trampoline_initial,@object

        .align  2

trampoline_initial:

        mflr    r0

        bcl     20,31,1f

.Lfunc = .-trampoline_initial

        .long   0                        /* will be replaced with function address */

.Lchain = .-trampoline_initial

        .long   0                        /* will be replaced with static chain */

1:      mflr    r11

        mtlr    r0

        lwz     r0,0(r11)               /* function address */

        lwz     r11,4(r11)              /* static chain */

        mtctr   r0

        bctr

trampoline_size = .-trampoline_initial

        .size   trampoline_initial,trampoline_size

/* R3 = stack address to store trampoline */

/* R4 = length of trampoline area */

/* R5 = function address */

/* R6 = static chain */

FUNC_START(__trampoline_setup)

        mflr    r0              /* save return address */

        bcl     20,31,.LCF0     /* load up __trampoline_initial into r7 */

.LCF0:

        mflr    r11

        addi    r7,r11,trampoline_initial-4-.LCF0 /* trampoline address -4 */

        li      r8,trampoline_size      /* verify that the trampoline is big enough */

        cmpw    cr1,r8,r4

        srwi    r4,r4,2         /* # words to move */

        addi    r9,r3,-4        /* adjust pointer for lwzu */

        mtctr   r4

        blt     cr1,.Labort

        mtlr    r0

        /* Copy the instructions to the stack */

.Lmove:

        lwzu    r10,4(r7)

        stwu    r10,4(r9)

        bdnz    .Lmove

        /* Store correct function and static chain */

        stw     r5,.Lfunc(r3)

        stw     r6,.Lchain(r3)

        /* Now flush both caches */

        mtctr   r4

.Lcache:

        icbi    0,r3

        dcbf    0,r3

        addi    r3,r3,4

        bdnz    .Lcache

        /* Finally synchronize things & return */

        sync

        isync

        blr

.Labort:

#if (defined __PIC__ || defined __pic__) && defined HAVE_AS_REL16

        bcl     20,31,1f

1:      mflr    r30

        addis   r30,r30,_GLOBAL_OFFSET_TABLE_-1b@ha

        addi    r30,r30,_GLOBAL_OFFSET_TABLE_-1b@l

#endif

        bl      JUMP_TARGET(abort)

FUNC_END(__trampoline_setup)

#endif