Subversion Repositories openrisc_me

/*

 * C startup code for the Fujitsu SPARClite demo board

 *

 * Copyright (c) 1995, 1996 Cygnus Support

 *

 * The authors hereby grant permission to use, copy, modify, distribute,

 * and license this software and its documentation for any purpose, provided

 * that existing copyright notices are retained in all copies and that this

 * notice is included verbatim in any distributions. No written agreement,

 * license, or royalty fee is required for any of the authorized uses.

 * Modifications to this software may be copyrighted by their authors

 * and need not follow the licensing terms described here, provided that

 * the new terms are clearly indicated on the first page of each file where

 * they apply.

 */

#include "asm.h"

.data

        .align  8

        .ascii  "DaTa"          ! this is the first address in the data section

        .long   SYM(sdata)

SYM(environ):

        .long   0

        .text

        .align 8

        .globl SYM(_start)

SYM(_start):

        .globl SYM(start)

SYM(start):

        /* see if the stack is already setup. if not, then default

         *  to using the value of %sp as set by the ROM monitor

         */

        sethi   %hi(__stack), %g1

        or      %g1,%lo(__stack),%g1

        cmp     %g0,%g1

        be      1f

        mov     %g1, %sp                                ! set the stack pointer

        mov     %sp, %fp

1:

        /* zero the bss section */

        sethi %hi(__bss_start),%g2

        or    %g2,%lo(__bss_start),%g2          ! start of bss

        sethi %hi(_end),%g3

        or    %g3,%lo(_end),%g3                 ! end of bss

        mov   %g0,%g1                           ! so std has two zeros

zerobss:

        std    %g0,[%g2]

        add    %g2,8,%g2

        cmp    %g2,%g3

        bleu,a zerobss

        nop

/*

 * copy prom & trap vectors to sram.

 */

        set 0x30000000, %l0

        set 0xfff8, %l1

        tst %l1                                 ! Set condition codes

copyloop:

        ldd [%l1], %l2

        std %l2, [%l0 + %l1]

        bg copyloop

        deccc 8, %l1

        set 0x30000000, %l0                     ! Base of new trap vector

        mov %l0, %tbr                           ! Install the new tbr

        set SYM(win_ovf_trap), %l1              ! Setup window overflow trap

        ldd [%l1], %l2

        std %l2, [%l0 + 5 * 16]

        ldd [%l1 + 8], %l2

        std %l2, [%l0 + 5 * 16 + 8]

        set SYM(win_unf_trap), %l1              ! Setup window underflow trap

        ldd [%l1], %l2

        std %l2, [%l0 + 6 * 16]

        ldd [%l1 + 8], %l2

        std %l2, [%l0 + 6 * 16 + 8]

/*

 * Try enabling the FPU by setting EF.  If that causes a trap, then we probably

 * don't have an FPU.

 */

        ldd [%l0 + 2 * 16], %l4                 ! Save original trap routine

        set SYM(no_fpu_trap), %l1               ! Install new one

        ldd [%l1], %l2

        std %l2, [%l0 + 2 * 16]

        mov %psr, %l0

        sethi %hi(0x1000), %l1

        bset %l1, %l0

!       mov %l0, %psr

        std %l4, [2 * 16]                       ! Restore original trap routine

/*

 * Move the data segment from it's ROM address to RAM where it

 * belongs.

 */

relocd:

#if 0   /* This code is broken.  FIXME */

        set (_sdata),%g2                        ! %g2 = start of data in aout file

        set SYM(environ),%g4                    ! %g4 = actual data base address

        set (_edata),%g3                        ! %g3 = end of where data should go

        subcc   %g3, %g4, %g5                   ! %g5 = length of data

        subcc   %g4, %g2, %g0                   ! need to relocate data ?

        ble     init

        ld      [%g4], %g6

        subcc   %g6, 1, %g0

        be      init

mvdata:

        subcc   %g5, 8, %g5

        ldd     [%g2 + %g5], %g6

        bg      mvdata

#endif

/*

 * initialize target specific stuff. Only execute these

 * functions it they exist.

 */

init:

        sethi   %hi(SYM(hardware_init_hook)), %g1

        or      %g1,%lo(SYM(hardware_init_hook)),%g1

        cmp     %g0,%g1

        be      1f

        nop

        call    SYM(hardware_init_hook)

        nop

1:

        sethi   %hi(SYM(software_init_hook)), %g1

        or      %g1,%lo(SYM(software_init_hook)),%g1

        cmp     %g0,%g1

        be      2f

        nop

        call    SYM(software_init_hook)

        nop

2:

        call SYM(main)

        nop

        /* call exit from the C library so atexit gets called, and the

         * C++ destructors get run. This calls our exit routine below

         * when it's done.

         */

        call    SYM(exit)

        nop

/*

 * This should drop control back to the ROM monitor, if there is

 * one.

 */

        .globl  SYM(_exit)

SYM(_exit):

        call    0

        nop

/*

 * Trap handlers.

 */

        .align 8

SYM(win_ovf_trap):

        sethi %hi(SYM(win_ovf)), %l3

        jmpl %lo(SYM(win_ovf))+%l3, %g0

        mov %wim, %l0

        nop

SYM(win_unf_trap):

        sethi %hi(SYM(win_unf)), %l3

        jmpl %lo(SYM(win_unf))+%l3, %g0

        mov %wim, %l0

        nop

SYM(no_fpu_trap):                       ! Come here when no fpu exists.

        jmpl %l2, %g0                   ! This just skips the

        rett %l2+4                      ! offending instruction.