| 1 |
/* -*- Mode: Asm -*- */ |
/* -*- Mode: Asm -*- */ |
| 2 |
|
|
| 3 |
/* Copyright (c) 2002 Michael Stumpf <mistumpf@de.pepperl-fuchs.com> |
/* Copyright (c) 2002 Michael Stumpf <mistumpf@de.pepperl-fuchs.com> |
| 4 |
|
Copyright (c) 2005 Anatoly Sokolov <aesok@post.ru> |
| 5 |
All rights reserved. |
All rights reserved. |
| 6 |
|
|
| 7 |
|
|
| 99 |
|
|
| 100 |
ENDFUNC |
ENDFUNC |
| 101 |
|
|
| 102 |
|
/* |
| 103 |
|
*---------------------------------------------------------------------------------------------- |
| 104 |
|
* split up in sign : exp : fraction : fraction extention |
| 105 |
|
* x T : rA3 : rA2:rA1:rA0: rAE |
| 106 |
|
* |
| 107 |
|
* if defined FPLIB_CHECK_FOR_NAN |
| 108 |
|
* does not return to calling function in case of NaN ! |
| 109 |
|
* -> call fp_split before pushing locals to stack!!! |
| 110 |
|
* |
| 111 |
|
*/ |
| 112 |
|
|
| 113 |
|
FUNCTION(__fp_split_a) |
| 114 |
|
|
| 115 |
|
GLOBAL(__fp_split_a) |
| 116 |
|
BST rA3, 7 ; T = sign |
| 117 |
|
|
| 118 |
|
ADD rA2, rA2 ; MSB of exponent to carry |
| 119 |
|
adc rA3, rA3 ; whole exponent in rA3, sign in C |
| 120 |
|
CPI rA3, 0xFF ; if no jump then C as hidden one is set |
| 121 |
|
BREQ .L_fp_split_a_nan |
| 122 |
|
CLR rAE ; clear fraction extension |
| 123 |
|
CP rAE, rA3 ; set C if nonzero exponent. |
| 124 |
|
BRCS 1f |
| 125 |
|
LDI rA3, 1 ; zero exponent really means 1 with hidden bit = 0 |
| 126 |
|
1: |
| 127 |
|
ROR rA2 ; sets hidden bit |
| 128 |
|
RET |
| 129 |
|
|
| 130 |
|
.L_fp_split_a_nan: |
| 131 |
|
POP rA3 |
| 132 |
|
POP rA3 ; pop return adress |
| 133 |
|
#ifdef __ERRNO__ |
| 134 |
|
LDI rA3, EDOM ; NaN is argument domain error ! |
| 135 |
|
#endif |
| 136 |
|
CLR r1 |
| 137 |
|
RJMP _U(__fp_nan) |
| 138 |
|
|
| 139 |
|
ENDFUNC |
| 140 |
|
|
| 141 |
|
|
| 142 |
#endif /* not __DOXYGEN__ */ |
#endif /* not __DOXYGEN__ */ |