David Feng | 85fd5f1 | 2013-12-14 11:47:35 +0800 | [diff] [blame] | 1 | /* |
| 2 | * (C) Copyright 2013 |
| 3 | * David Feng <fenghua@phytium.com.cn> |
| 4 | * |
| 5 | * SPDX-License-Identifier: GPL-2.0+ |
| 6 | */ |
| 7 | |
| 8 | #include <asm-offsets.h> |
| 9 | #include <config.h> |
David Feng | 85fd5f1 | 2013-12-14 11:47:35 +0800 | [diff] [blame] | 10 | #include <asm/ptrace.h> |
| 11 | #include <asm/macro.h> |
| 12 | #include <linux/linkage.h> |
| 13 | |
| 14 | /* |
| 15 | * Enter Exception. |
| 16 | * This will save the processor state that is ELR/X0~X30 |
| 17 | * to the stack frame. |
| 18 | */ |
| 19 | .macro exception_entry |
| 20 | stp x29, x30, [sp, #-16]! |
| 21 | stp x27, x28, [sp, #-16]! |
| 22 | stp x25, x26, [sp, #-16]! |
| 23 | stp x23, x24, [sp, #-16]! |
| 24 | stp x21, x22, [sp, #-16]! |
| 25 | stp x19, x20, [sp, #-16]! |
| 26 | stp x17, x18, [sp, #-16]! |
| 27 | stp x15, x16, [sp, #-16]! |
| 28 | stp x13, x14, [sp, #-16]! |
| 29 | stp x11, x12, [sp, #-16]! |
| 30 | stp x9, x10, [sp, #-16]! |
| 31 | stp x7, x8, [sp, #-16]! |
| 32 | stp x5, x6, [sp, #-16]! |
| 33 | stp x3, x4, [sp, #-16]! |
| 34 | stp x1, x2, [sp, #-16]! |
| 35 | |
| 36 | /* Could be running at EL3/EL2/EL1 */ |
| 37 | switch_el x11, 3f, 2f, 1f |
| 38 | 3: mrs x1, esr_el3 |
| 39 | mrs x2, elr_el3 |
| 40 | b 0f |
| 41 | 2: mrs x1, esr_el2 |
| 42 | mrs x2, elr_el2 |
| 43 | b 0f |
| 44 | 1: mrs x1, esr_el1 |
| 45 | mrs x2, elr_el1 |
| 46 | 0: |
| 47 | stp x2, x0, [sp, #-16]! |
| 48 | mov x0, sp |
| 49 | .endm |
| 50 | |
| 51 | /* |
| 52 | * Exception vectors. |
| 53 | */ |
| 54 | .align 11 |
| 55 | .globl vectors |
| 56 | vectors: |
| 57 | .align 7 |
| 58 | b _do_bad_sync /* Current EL Synchronous Thread */ |
| 59 | |
| 60 | .align 7 |
| 61 | b _do_bad_irq /* Current EL IRQ Thread */ |
| 62 | |
| 63 | .align 7 |
| 64 | b _do_bad_fiq /* Current EL FIQ Thread */ |
| 65 | |
| 66 | .align 7 |
| 67 | b _do_bad_error /* Current EL Error Thread */ |
| 68 | |
| 69 | .align 7 |
| 70 | b _do_sync /* Current EL Synchronous Handler */ |
| 71 | |
| 72 | .align 7 |
| 73 | b _do_irq /* Current EL IRQ Handler */ |
| 74 | |
| 75 | .align 7 |
| 76 | b _do_fiq /* Current EL FIQ Handler */ |
| 77 | |
| 78 | .align 7 |
| 79 | b _do_error /* Current EL Error Handler */ |
| 80 | |
| 81 | |
| 82 | _do_bad_sync: |
| 83 | exception_entry |
| 84 | bl do_bad_sync |
| 85 | |
| 86 | _do_bad_irq: |
| 87 | exception_entry |
| 88 | bl do_bad_irq |
| 89 | |
| 90 | _do_bad_fiq: |
| 91 | exception_entry |
| 92 | bl do_bad_fiq |
| 93 | |
| 94 | _do_bad_error: |
| 95 | exception_entry |
| 96 | bl do_bad_error |
| 97 | |
| 98 | _do_sync: |
| 99 | exception_entry |
| 100 | bl do_sync |
| 101 | |
| 102 | _do_irq: |
| 103 | exception_entry |
| 104 | bl do_irq |
| 105 | |
| 106 | _do_fiq: |
| 107 | exception_entry |
| 108 | bl do_fiq |
| 109 | |
| 110 | _do_error: |
| 111 | exception_entry |
| 112 | bl do_error |