1 /*
2  * SPDX-License-Identifier: BSD-3-Clause
3  *
4  * Copyright © 2023 Keith Packard
5  *
6  * Redistribution and use in source and binary forms, with or without
7  * modification, are permitted provided that the following conditions
8  * are met:
9  *
10  * 1. Redistributions of source code must retain the above copyright
11  *    notice, this list of conditions and the following disclaimer.
12  *
13  * 2. Redistributions in binary form must reproduce the above
14  *    copyright notice, this list of conditions and the following
15  *    disclaimer in the documentation and/or other materials provided
16  *    with the distribution.
17  *
18  * 3. Neither the name of the copyright holder nor the names of its
19  *    contributors may be used to endorse or promote products derived
20  *    from this software without specific prior written permission.
21  *
22  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
23  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
24  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
25  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
26  * COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT,
27  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
28  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
29  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
30  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
31  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
32  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED
33  * OF THE POSSIBILITY OF SUCH DAMAGE.
34  */
35 
36 #include "../../crt0.h"
37 
38 static void __attribute__((used)) __section(".init")
_cstart(void)39 _cstart(void)
40 {
41 	__start();
42 }
43 
44 extern char __stack[];
45 extern char __interrupt_vector[];
46 
47 void __section(".init") __attribute__((used))
_start(void)48 _start(void)
49 {
50         /* Initialize trap base register */
51         __asm__("wr %0, %%tbr" : : "r" (__interrupt_vector));
52 
53 	/* Initialize stack pointer */
54 	__asm__("sethi %%hi(%0), %%sp" : : "i" (__stack));
55 	__asm__("or  %%sp, %%lo(%0), %%sp" : : "i" (__stack));
56 
57         /* Enable interrupts */
58         __asm__("wr %g0, 2, %wim");
59         __asm__("wr %g0, 0xfe0, %psr");
60 
61 	/* Branch to C code */
62         __asm__("jmp %0" : : "r" (_cstart));
63         __asm__("nop");
64 }
65