1 /*
2 * SPDX-License-Identifier: BSD-3-Clause
3 *
4 * Copyright © 2019 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 <stdint.h>
37
38 void aarch64_halt_vector(void);
39
40 void __section(".init")
aarch64_halt_vector(void)41 aarch64_halt_vector(void)
42 {
43 /* Loop forever. */
44 for(;;);
45 }
46
47 void aarch64_ignore_vector(void);
48
49 void __section(".init")
aarch64_ignore_vector(void)50 aarch64_ignore_vector(void)
51 {
52 /* Ignore the interrupt by returning */
53 }
54
55 #define vector(name) \
56 void aarch64_ ## name ## _vector(void) __attribute__ ((weak, alias("aarch64_ignore_vector")))
57
58 #define vector_halt(name) \
59 void aarch64_ ## name ## _vector(void) __attribute__ ((weak, alias("aarch64_halt_vector")))
60
61 vector_halt(sync);
62 vector_halt(serror);
63 vector(irq);
64 vector(fiq);
65
66 void
67 __weak_vector_table(void);
68
69 void __section(".text.init.enter") __attribute__((aligned(2048)))
__weak_vector_table(void)70 __weak_vector_table(void)
71 {
72 /*
73 * Exception vector
74 */
75 __asm__("SP_EL0:\n"
76 "b aarch64_sync_vector\n"
77 ". = SP_EL0 + 0x80\n"
78 "b aarch64_irq_vector\n"
79 ". = SP_EL0 + 0x100\n"
80 "b aarch64_fiq_vector\n"
81 ". = SP_EL0 + 0x180\n"
82 "b aarch64_serror_vector\n"
83 ". = SP_EL0 + 0x200\n"
84 "SP_ELx:\n"
85 "b aarch64_sync_vector\n"
86 ". = SP_ELx + 0x80\n"
87 "b aarch64_irq_vector\n"
88 ". = SP_ELx + 0x100\n"
89 "b aarch64_fiq_vector\n"
90 ". = SP_ELx + 0x180\n"
91 "b aarch64_serror_vector\n"
92 ". = SP_ELx + 0x200\n");
93 }
94
95 __weak_reference(__weak_vector_table, __vector_table);
96
