1 | 2 | x_store.sa 3.2 1/24/91 3 | 4 | store --- store operand to memory or register 5 | 6 | Used by underflow and overflow handlers. 7 | 8 | a6 = points to fp value to be stored. 9 | 10 11 | Copyright (C) Motorola, Inc. 1990 12 | All Rights Reserved 13 | 14 | For details on the license for this file, please see the 15 | file, README, in this same directory. 16 17 X_STORE: |idnt 2,1 | Motorola 040 Floating Point Software Package 18 19 |section 8 20 21 fpreg_mask: 22 .byte 0x80,0x40,0x20,0x10,0x08,0x04,0x02,0x01 23 24 #include "fpsp.h" 25 26 |xref mem_write 27 |xref get_fline 28 |xref g_opcls 29 |xref g_dfmtou 30 |xref reg_dest 31 32 .global dest_ext 33 .global dest_dbl 34 .global dest_sgl 35 36 .global store 37 store: 38 btstb #E3,E_BYTE(%a6) 39 beqs E1_sto 40 E3_sto: 41 movel CMDREG3B(%a6),%d0 42 bfextu %d0{#6:#3},%d0 |isolate dest. reg from cmdreg3b 43 sto_fp: 44 lea fpreg_mask,%a1 45 moveb (%a1,%d0.w),%d0 |convert reg# to dynamic register mask 46 tstb LOCAL_SGN(%a0) 47 beqs is_pos 48 bsetb #sign_bit,LOCAL_EX(%a0) 49 is_pos: 50 fmovemx (%a0),%d0 |move to correct register 51 | 52 | if fp0-fp3 is being modified, we must put a copy 53 | in the USER_FPn variable on the stack because all exception 54 | handlers restore fp0-fp3 from there. 55 | 56 cmpb #0x80,%d0 57 bnes not_fp0 58 fmovemx %fp0-%fp0,USER_FP0(%a6) 59 rts 60 not_fp0: 61 cmpb #0x40,%d0 62 bnes not_fp1 63 fmovemx %fp1-%fp1,USER_FP1(%a6) 64 rts 65 not_fp1: 66 cmpb #0x20,%d0 67 bnes not_fp2 68 fmovemx %fp2-%fp2,USER_FP2(%a6) 69 rts 70 not_fp2: 71 cmpb #0x10,%d0 72 bnes not_fp3 73 fmovemx %fp3-%fp3,USER_FP3(%a6) 74 rts 75 not_fp3: 76 rts 77 78 E1_sto: 79 bsrl g_opcls |returns opclass in d0 80 cmpib #3,%d0 81 beq opc011 |branch if opclass 3 82 movel CMDREG1B(%a6),%d0 83 bfextu %d0{#6:#3},%d0 |extract destination register 84 bras sto_fp 85 86 opc011: 87 bsrl g_dfmtou |returns dest format in d0 88 | ;ext=00, sgl=01, dbl=10 89 movel %a0,%a1 |save source addr in a1 90 movel EXC_EA(%a6),%a0 |get the address 91 cmpil #0,%d0 |if dest format is extended 92 beq dest_ext |then branch 93 cmpil #1,%d0 |if dest format is single 94 beq dest_sgl |then branch 95 | 96 | fall through to dest_dbl 97 | 98 99 | 100 | dest_dbl --- write double precision value to user space 101 | 102 |Input 103 | a0 -> destination address 104 | a1 -> source in extended precision 105 |Output 106 | a0 -> destroyed 107 | a1 -> destroyed 108 | d0 -> 0 109 | 110 |Changes extended precision to double precision. 111 | Note: no attempt is made to round the extended value to double. 112 | dbl_sign = ext_sign 113 | dbl_exp = ext_exp - $3fff(ext bias) + $7ff(dbl bias) 114 | get rid of ext integer bit 115 | dbl_mant = ext_mant{62:12} 116 | 117 | --------------- --------------- --------------- 118 | extended -> |s| exp | |1| ms mant | | ls mant | 119 | --------------- --------------- --------------- 120 | 95 64 63 62 32 31 11 0 121 | | | 122 | | | 123 | | | 124 | v v 125 | --------------- --------------- 126 | double -> |s|exp| mant | | mant | 127 | --------------- --------------- 128 | 63 51 32 31 0 129 | 130 dest_dbl: 131 clrl %d0 |clear d0 132 movew LOCAL_EX(%a1),%d0 |get exponent 133 subw #0x3fff,%d0 |subtract extended precision bias 134 cmpw #0x4000,%d0 |check if inf 135 beqs inf |if so, special case 136 addw #0x3ff,%d0 |add double precision bias 137 swap %d0 |d0 now in upper word 138 lsll #4,%d0 |d0 now in proper place for dbl prec exp 139 tstb LOCAL_SGN(%a1) 140 beqs get_mant |if positive, go process mantissa 141 bsetl #31,%d0 |if negative, put in sign information 142 | ; before continuing 143 bras get_mant |go process mantissa 144 inf: 145 movel #0x7ff00000,%d0 |load dbl inf exponent 146 clrl LOCAL_HI(%a1) |clear msb 147 tstb LOCAL_SGN(%a1) 148 beqs dbl_inf |if positive, go ahead and write it 149 bsetl #31,%d0 |if negative put in sign information 150 dbl_inf: 151 movel %d0,LOCAL_EX(%a1) |put the new exp back on the stack 152 bras dbl_wrt 153 get_mant: 154 movel LOCAL_HI(%a1),%d1 |get ms mantissa 155 bfextu %d1{#1:#20},%d1 |get upper 20 bits of ms 156 orl %d1,%d0 |put these bits in ms word of double 157 movel %d0,LOCAL_EX(%a1) |put the new exp back on the stack 158 movel LOCAL_HI(%a1),%d1 |get ms mantissa 159 movel #21,%d0 |load shift count 160 lsll %d0,%d1 |put lower 11 bits in upper bits 161 movel %d1,LOCAL_HI(%a1) |build lower lword in memory 162 movel LOCAL_LO(%a1),%d1 |get ls mantissa 163 bfextu %d1{#0:#21},%d0 |get ls 21 bits of double 164 orl %d0,LOCAL_HI(%a1) |put them in double result 165 dbl_wrt: 166 movel #0x8,%d0 |byte count for double precision number 167 exg %a0,%a1 |a0=supervisor source, a1=user dest 168 bsrl mem_write |move the number to the user's memory 169 rts 170 | 171 | dest_sgl --- write single precision value to user space 172 | 173 |Input 174 | a0 -> destination address 175 | a1 -> source in extended precision 176 | 177 |Output 178 | a0 -> destroyed 179 | a1 -> destroyed 180 | d0 -> 0 181 | 182 |Changes extended precision to single precision. 183 | sgl_sign = ext_sign 184 | sgl_exp = ext_exp - $3fff(ext bias) + $7f(sgl bias) 185 | get rid of ext integer bit 186 | sgl_mant = ext_mant{62:12} 187 | 188 | --------------- --------------- --------------- 189 | extended -> |s| exp | |1| ms mant | | ls mant | 190 | --------------- --------------- --------------- 191 | 95 64 63 62 40 32 31 12 0 192 | | | 193 | | | 194 | | | 195 | v v 196 | --------------- 197 | single -> |s|exp| mant | 198 | --------------- 199 | 31 22 0 200 | 201 dest_sgl: 202 clrl %d0 203 movew LOCAL_EX(%a1),%d0 |get exponent 204 subw #0x3fff,%d0 |subtract extended precision bias 205 cmpw #0x4000,%d0 |check if inf 206 beqs sinf |if so, special case 207 addw #0x7f,%d0 |add single precision bias 208 swap %d0 |put exp in upper word of d0 209 lsll #7,%d0 |shift it into single exp bits 210 tstb LOCAL_SGN(%a1) 211 beqs get_sman |if positive, continue 212 bsetl #31,%d0 |if negative, put in sign first 213 bras get_sman |get mantissa 214 sinf: 215 movel #0x7f800000,%d0 |load single inf exp to d0 216 tstb LOCAL_SGN(%a1) 217 beqs sgl_wrt |if positive, continue 218 bsetl #31,%d0 |if negative, put in sign info 219 bras sgl_wrt 220 221 get_sman: 222 movel LOCAL_HI(%a1),%d1 |get ms mantissa 223 bfextu %d1{#1:#23},%d1 |get upper 23 bits of ms 224 orl %d1,%d0 |put these bits in ms word of single 225 226 sgl_wrt: 227 movel %d0,L_SCR1(%a6) |put the new exp back on the stack 228 movel #0x4,%d0 |byte count for single precision number 229 tstl %a0 |users destination address 230 beqs sgl_Dn |destination is a data register 231 exg %a0,%a1 |a0=supervisor source, a1=user dest 232 leal L_SCR1(%a6),%a0 |point a0 to data 233 bsrl mem_write |move the number to the user's memory 234 rts 235 sgl_Dn: 236 bsrl get_fline |returns fline word in d0 237 andw #0x7,%d0 |isolate register number 238 movel %d0,%d1 |d1 has size:reg formatted for reg_dest 239 orl #0x10,%d1 |reg_dest wants size added to reg# 240 bral reg_dest |size is X, rts in reg_dest will 241 | ;return to caller of dest_sgl 242 243 dest_ext: 244 tstb LOCAL_SGN(%a1) |put back sign into exponent word 245 beqs dstx_cont 246 bsetb #sign_bit,LOCAL_EX(%a1) 247 dstx_cont: 248 clrb LOCAL_SGN(%a1) |clear out the sign byte 249 250 movel #0x0c,%d0 |byte count for extended number 251 exg %a0,%a1 |a0=supervisor source, a1=user dest 252 bsrl mem_write |move the number to the user's memory 253 rts 254 255 |end 256