| 1 |
#------------------------------------------------------------------------------ |
| 2 |
# |
| 3 |
# Copyright (c) 2011, ARM. All rights reserved.<BR> |
| 4 |
# |
| 5 |
# This program and the accompanying materials |
| 6 |
# are licensed and made available under the terms and conditions of the BSD License |
| 7 |
# which accompanies this distribution. The full text of the license may be found at |
| 8 |
# http://opensource.org/licenses/bsd-license.php |
| 9 |
# |
| 10 |
# THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS, |
| 11 |
# WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED. |
| 12 |
# |
| 13 |
#------------------------------------------------------------------------------ |
| 14 |
|
| 15 |
#include "edk2asm.h" |
| 16 |
|
| 17 |
.text |
| 18 |
.align 2 |
| 19 |
GCC_ASM_EXPORT(__aeabi_uidiv) |
| 20 |
GCC_ASM_EXPORT(__aeabi_uidivmod) |
| 21 |
GCC_ASM_EXPORT(__aeabi_idiv) |
| 22 |
GCC_ASM_EXPORT(__aeabi_idivmod) |
| 23 |
|
| 24 |
# AREA Math, CODE, READONLY |
| 25 |
|
| 26 |
# |
| 27 |
#UINT32 |
| 28 |
#EFIAPI |
| 29 |
#__aeabi_uidivmode ( |
| 30 |
# IN UINT32 Dividen |
| 31 |
# IN UINT32 Divisor |
| 32 |
# ); |
| 33 |
# |
| 34 |
|
| 35 |
ASM_PFX(__aeabi_uidiv): |
| 36 |
ASM_PFX(__aeabi_uidivmod): |
| 37 |
rsbs r12, r1, r0, LSR #4 |
| 38 |
mov r2, #0 |
| 39 |
bcc ASM_PFX(__arm_div4) |
| 40 |
rsbs r12, r1, r0, LSR #8 |
| 41 |
bcc ASM_PFX(__arm_div8) |
| 42 |
mov r3, #0 |
| 43 |
b ASM_PFX(__arm_div_large) |
| 44 |
|
| 45 |
# |
| 46 |
#INT32 |
| 47 |
#EFIAPI |
| 48 |
#__aeabi_idivmode ( |
| 49 |
# IN INT32 Dividen |
| 50 |
# IN INT32 Divisor |
| 51 |
# ); |
| 52 |
# |
| 53 |
ASM_PFX(__aeabi_idiv): |
| 54 |
ASM_PFX(__aeabi_idivmod): |
| 55 |
orrs r12, r0, r1 |
| 56 |
bmi ASM_PFX(__arm_div_negative) |
| 57 |
rsbs r12, r1, r0, LSR #1 |
| 58 |
mov r2, #0 |
| 59 |
bcc ASM_PFX(__arm_div1) |
| 60 |
rsbs r12, r1, r0, LSR #4 |
| 61 |
bcc ASM_PFX(__arm_div4) |
| 62 |
rsbs r12, r1, r0, LSR #8 |
| 63 |
bcc ASM_PFX(__arm_div8) |
| 64 |
mov r3, #0 |
| 65 |
b ASM_PFX(__arm_div_large) |
| 66 |
ASM_PFX(__arm_div8): |
| 67 |
rsbs r12, r1, r0, LSR #7 |
| 68 |
subcs r0, r0, r1, LSL #7 |
| 69 |
adc r2, r2, r2 |
| 70 |
rsbs r12, r1, r0,LSR #6 |
| 71 |
subcs r0, r0, r1, LSL #6 |
| 72 |
adc r2, r2, r2 |
| 73 |
rsbs r12, r1, r0, LSR #5 |
| 74 |
subcs r0, r0, r1, LSL #5 |
| 75 |
adc r2, r2, r2 |
| 76 |
rsbs r12, r1, r0, LSR #4 |
| 77 |
subcs r0, r0, r1, LSL #4 |
| 78 |
adc r2, r2, r2 |
| 79 |
ASM_PFX(__arm_div4): |
| 80 |
rsbs r12, r1, r0, LSR #3 |
| 81 |
subcs r0, r0, r1, LSL #3 |
| 82 |
adc r2, r2, r2 |
| 83 |
rsbs r12, r1, r0, LSR #2 |
| 84 |
subcs r0, r0, r1, LSL #2 |
| 85 |
adcs r2, r2, r2 |
| 86 |
rsbs r12, r1, r0, LSR #1 |
| 87 |
subcs r0, r0, r1, LSL #1 |
| 88 |
adc r2, r2, r2 |
| 89 |
ASM_PFX(__arm_div1): |
| 90 |
subs r1, r0, r1 |
| 91 |
movcc r1, r0 |
| 92 |
adc r0, r2, r2 |
| 93 |
bx r14 |
| 94 |
ASM_PFX(__arm_div_negative): |
| 95 |
ands r2, r1, #0x80000000 |
| 96 |
rsbmi r1, r1, #0 |
| 97 |
eors r3, r2, r0, ASR #32 |
| 98 |
rsbcs r0, r0, #0 |
| 99 |
rsbs r12, r1, r0, LSR #4 |
| 100 |
bcc label1 |
| 101 |
rsbs r12, r1, r0, LSR #8 |
| 102 |
bcc label2 |
| 103 |
ASM_PFX(__arm_div_large): |
| 104 |
lsl r1, r1, #6 |
| 105 |
rsbs r12, r1, r0, LSR #8 |
| 106 |
orr r2, r2, #0xfc000000 |
| 107 |
bcc label2 |
| 108 |
lsl r1, r1, #6 |
| 109 |
rsbs r12, r1, r0, LSR #8 |
| 110 |
orr r2, r2, #0x3f00000 |
| 111 |
bcc label2 |
| 112 |
lsl r1, r1, #6 |
| 113 |
rsbs r12, r1, r0, LSR #8 |
| 114 |
orr r2, r2, #0xfc000 |
| 115 |
orrcs r2, r2, #0x3f00 |
| 116 |
lslcs r1, r1, #6 |
| 117 |
rsbs r12, r1, #0 |
| 118 |
bcs ASM_PFX(__aeabi_idiv0) |
| 119 |
label3: |
| 120 |
lsrcs r1, r1, #6 |
| 121 |
label2: |
| 122 |
rsbs r12, r1, r0, LSR #7 |
| 123 |
subcs r0, r0, r1, LSL #7 |
| 124 |
adc r2, r2, r2 |
| 125 |
rsbs r12, r1, r0, LSR #6 |
| 126 |
subcs r0, r0, r1, LSL #6 |
| 127 |
adc r2, r2, r2 |
| 128 |
rsbs r12, r1, r0, LSR #5 |
| 129 |
subcs r0, r0, r1, LSL #5 |
| 130 |
adc r2, r2, r2 |
| 131 |
rsbs r12, r1, r0, LSR #4 |
| 132 |
subcs r0, r0, r1, LSL #4 |
| 133 |
adc r2, r2, r2 |
| 134 |
label1: |
| 135 |
rsbs r12, r1, r0, LSR #3 |
| 136 |
subcs r0, r0, r1, LSL #3 |
| 137 |
adc r2, r2, r2 |
| 138 |
rsbs r12, r1, r0, LSR #2 |
| 139 |
subcs r0, r0, r1, LSL #2 |
| 140 |
adcs r2, r2, r2 |
| 141 |
bcs label3 |
| 142 |
rsbs r12, r1, r0, LSR #1 |
| 143 |
subcs r0, r0, r1, LSL #1 |
| 144 |
adc r2, r2, r2 |
| 145 |
subs r1, r0, r1 |
| 146 |
movcc r1, r0 |
| 147 |
adc r0, r2, r2 |
| 148 |
asrs r3, r3, #31 |
| 149 |
rsbmi r0, r0, #0 |
| 150 |
rsbcs r1, r1, #0 |
| 151 |
bx r14 |
| 152 |
|
| 153 |
@ What to do about division by zero? For now, just return. |
| 154 |
ASM_PFX(__aeabi_idiv0): |
| 155 |
bx r14 |
| 156 |
.section .note.GNU-stack,"a" |