[PATCH] Add wording to m68k .S files to help clarify license info
[linux-3.10.git] / arch / m68k / fpsp040 / x_store.S
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