xref: /openbmc/linux/arch/m68k/fpsp040/srem_mod.S (revision e00d82d0)
1|
2|	srem_mod.sa 3.1 12/10/90
3|
4|      The entry point sMOD computes the floating point MOD of the
5|      input values X and Y. The entry point sREM computes the floating
6|      point (IEEE) REM of the input values X and Y.
7|
8|      INPUT
9|      -----
10|      Double-extended value Y is pointed to by address in register
11|      A0. Double-extended value X is located in -12(A0). The values
12|      of X and Y are both nonzero and finite; although either or both
13|      of them can be denormalized. The special cases of zeros, NaNs,
14|      and infinities are handled elsewhere.
15|
16|      OUTPUT
17|      ------
18|      FREM(X,Y) or FMOD(X,Y), depending on entry point.
19|
20|       ALGORITHM
21|       ---------
22|
23|       Step 1.  Save and strip signs of X and Y: signX := sign(X),
24|                signY := sign(Y), X := |X|, Y := |Y|,
25|                signQ := signX EOR signY. Record whether MOD or REM
26|                is requested.
27|
28|       Step 2.  Set L := expo(X)-expo(Y), k := 0, Q := 0.
29|                If (L < 0) then
30|                   R := X, go to Step 4.
31|                else
32|                   R := 2^(-L)X, j := L.
33|                endif
34|
35|       Step 3.  Perform MOD(X,Y)
36|            3.1 If R = Y, go to Step 9.
37|            3.2 If R > Y, then { R := R - Y, Q := Q + 1}
38|            3.3 If j = 0, go to Step 4.
39|            3.4 k := k + 1, j := j - 1, Q := 2Q, R := 2R. Go to
40|                Step 3.1.
41|
42|       Step 4.  At this point, R = X - QY = MOD(X,Y). Set
43|                Last_Subtract := false (used in Step 7 below). If
44|                MOD is requested, go to Step 6.
45|
46|       Step 5.  R = MOD(X,Y), but REM(X,Y) is requested.
47|            5.1 If R < Y/2, then R = MOD(X,Y) = REM(X,Y). Go to
48|                Step 6.
49|            5.2 If R > Y/2, then { set Last_Subtract := true,
50|                Q := Q + 1, Y := signY*Y }. Go to Step 6.
51|            5.3 This is the tricky case of R = Y/2. If Q is odd,
52|                then { Q := Q + 1, signX := -signX }.
53|
54|       Step 6.  R := signX*R.
55|
56|       Step 7.  If Last_Subtract = true, R := R - Y.
57|
58|       Step 8.  Return signQ, last 7 bits of Q, and R as required.
59|
60|       Step 9.  At this point, R = 2^(-j)*X - Q Y = Y. Thus,
61|                X = 2^(j)*(Q+1)Y. set Q := 2^(j)*(Q+1),
62|                R := 0. Return signQ, last 7 bits of Q, and R.
63|
64|
65
66|		Copyright (C) Motorola, Inc. 1990
67|			All Rights Reserved
68|
69|       For details on the license for this file, please see the
70|       file, README, in this same directory.
71
72SREM_MOD:    |idnt    2,1 | Motorola 040 Floating Point Software Package
73
74	|section    8
75
76#include "fpsp.h"
77
78	.set	Mod_Flag,L_SCR3
79	.set	SignY,FP_SCR3+4
80	.set	SignX,FP_SCR3+8
81	.set	SignQ,FP_SCR3+12
82	.set	Sc_Flag,FP_SCR4
83
84	.set	Y,FP_SCR1
85	.set	Y_Hi,Y+4
86	.set	Y_Lo,Y+8
87
88	.set	R,FP_SCR2
89	.set	R_Hi,R+4
90	.set	R_Lo,R+8
91
92
93Scale:     .long	0x00010000,0x80000000,0x00000000,0x00000000
94
95	|xref	t_avoid_unsupp
96
97        .global        smod
98smod:
99
100   movel               #0,Mod_Flag(%a6)
101   bras                Mod_Rem
102
103        .global        srem
104srem:
105
106   movel               #1,Mod_Flag(%a6)
107
108Mod_Rem:
109|..Save sign of X and Y
110   moveml              %d2-%d7,-(%a7)     | ...save data registers
111   movew               (%a0),%d3
112   movew               %d3,SignY(%a6)
113   andil               #0x00007FFF,%d3   | ...Y := |Y|
114
115|
116   movel               4(%a0),%d4
117   movel               8(%a0),%d5        | ...(D3,D4,D5) is |Y|
118
119   tstl                %d3
120   bnes                Y_Normal
121
122   movel               #0x00003FFE,%d3	| ...$3FFD + 1
123   tstl                %d4
124   bnes                HiY_not0
125
126HiY_0:
127   movel               %d5,%d4
128   clrl                %d5
129   subil               #32,%d3
130   clrl                %d6
131   bfffo                %d4{#0:#32},%d6
132   lsll                %d6,%d4
133   subl                %d6,%d3           | ...(D3,D4,D5) is normalized
134|                                       ...with bias $7FFD
135   bras                Chk_X
136
137HiY_not0:
138   clrl                %d6
139   bfffo                %d4{#0:#32},%d6
140   subl                %d6,%d3
141   lsll                %d6,%d4
142   movel               %d5,%d7           | ...a copy of D5
143   lsll                %d6,%d5
144   negl                %d6
145   addil               #32,%d6
146   lsrl                %d6,%d7
147   orl                 %d7,%d4           | ...(D3,D4,D5) normalized
148|                                       ...with bias $7FFD
149   bras                Chk_X
150
151Y_Normal:
152   addil               #0x00003FFE,%d3   | ...(D3,D4,D5) normalized
153|                                       ...with bias $7FFD
154
155Chk_X:
156   movew               -12(%a0),%d0
157   movew               %d0,SignX(%a6)
158   movew               SignY(%a6),%d1
159   eorl                %d0,%d1
160   andil               #0x00008000,%d1
161   movew               %d1,SignQ(%a6)	| ...sign(Q) obtained
162   andil               #0x00007FFF,%d0
163   movel               -8(%a0),%d1
164   movel               -4(%a0),%d2       | ...(D0,D1,D2) is |X|
165   tstl                %d0
166   bnes                X_Normal
167   movel               #0x00003FFE,%d0
168   tstl                %d1
169   bnes                HiX_not0
170
171HiX_0:
172   movel               %d2,%d1
173   clrl                %d2
174   subil               #32,%d0
175   clrl                %d6
176   bfffo                %d1{#0:#32},%d6
177   lsll                %d6,%d1
178   subl                %d6,%d0           | ...(D0,D1,D2) is normalized
179|                                       ...with bias $7FFD
180   bras                Init
181
182HiX_not0:
183   clrl                %d6
184   bfffo                %d1{#0:#32},%d6
185   subl                %d6,%d0
186   lsll                %d6,%d1
187   movel               %d2,%d7           | ...a copy of D2
188   lsll                %d6,%d2
189   negl                %d6
190   addil               #32,%d6
191   lsrl                %d6,%d7
192   orl                 %d7,%d1           | ...(D0,D1,D2) normalized
193|                                       ...with bias $7FFD
194   bras                Init
195
196X_Normal:
197   addil               #0x00003FFE,%d0   | ...(D0,D1,D2) normalized
198|                                       ...with bias $7FFD
199
200Init:
201|
202   movel               %d3,L_SCR1(%a6)   | ...save biased expo(Y)
203   movel		%d0,L_SCR2(%a6)	|save d0
204   subl                %d3,%d0           | ...L := expo(X)-expo(Y)
205|   Move.L               D0,L            ...D0 is j
206   clrl                %d6              | ...D6 := carry <- 0
207   clrl                %d3              | ...D3 is Q
208   moveal              #0,%a1           | ...A1 is k; j+k=L, Q=0
209
210|..(Carry,D1,D2) is R
211   tstl                %d0
212   bges                Mod_Loop
213
214|..expo(X) < expo(Y). Thus X = mod(X,Y)
215|
216   movel		L_SCR2(%a6),%d0	|restore d0
217   bra                Get_Mod
218
219|..At this point  R = 2^(-L)X; Q = 0; k = 0; and  k+j = L
220
221
222Mod_Loop:
223   tstl                %d6              | ...test carry bit
224   bgts                R_GT_Y
225
226|..At this point carry = 0, R = (D1,D2), Y = (D4,D5)
227   cmpl                %d4,%d1           | ...compare hi(R) and hi(Y)
228   bnes                R_NE_Y
229   cmpl                %d5,%d2           | ...compare lo(R) and lo(Y)
230   bnes                R_NE_Y
231
232|..At this point, R = Y
233   bra                Rem_is_0
234
235R_NE_Y:
236|..use the borrow of the previous compare
237   bcss                R_LT_Y          | ...borrow is set iff R < Y
238
239R_GT_Y:
240|..If Carry is set, then Y < (Carry,D1,D2) < 2Y. Otherwise, Carry = 0
241|..and Y < (D1,D2) < 2Y. Either way, perform R - Y
242   subl                %d5,%d2           | ...lo(R) - lo(Y)
243   subxl               %d4,%d1           | ...hi(R) - hi(Y)
244   clrl                %d6              | ...clear carry
245   addql               #1,%d3           | ...Q := Q + 1
246
247R_LT_Y:
248|..At this point, Carry=0, R < Y. R = 2^(k-L)X - QY; k+j = L; j >= 0.
249   tstl                %d0              | ...see if j = 0.
250   beqs                PostLoop
251
252   addl                %d3,%d3           | ...Q := 2Q
253   addl                %d2,%d2           | ...lo(R) = 2lo(R)
254   roxll               #1,%d1           | ...hi(R) = 2hi(R) + carry
255   scs                  %d6              | ...set Carry if 2(R) overflows
256   addql               #1,%a1           | ...k := k+1
257   subql               #1,%d0           | ...j := j - 1
258|..At this point, R=(Carry,D1,D2) = 2^(k-L)X - QY, j+k=L, j >= 0, R < 2Y.
259
260   bras                Mod_Loop
261
262PostLoop:
263|..k = L, j = 0, Carry = 0, R = (D1,D2) = X - QY, R < Y.
264
265|..normalize R.
266   movel               L_SCR1(%a6),%d0           | ...new biased expo of R
267   tstl                %d1
268   bnes                HiR_not0
269
270HiR_0:
271   movel               %d2,%d1
272   clrl                %d2
273   subil               #32,%d0
274   clrl                %d6
275   bfffo                %d1{#0:#32},%d6
276   lsll                %d6,%d1
277   subl                %d6,%d0           | ...(D0,D1,D2) is normalized
278|                                       ...with bias $7FFD
279   bras                Get_Mod
280
281HiR_not0:
282   clrl                %d6
283   bfffo                %d1{#0:#32},%d6
284   bmis                Get_Mod         | ...already normalized
285   subl                %d6,%d0
286   lsll                %d6,%d1
287   movel               %d2,%d7           | ...a copy of D2
288   lsll                %d6,%d2
289   negl                %d6
290   addil               #32,%d6
291   lsrl                %d6,%d7
292   orl                 %d7,%d1           | ...(D0,D1,D2) normalized
293
294|
295Get_Mod:
296   cmpil		#0x000041FE,%d0
297   bges		No_Scale
298Do_Scale:
299   movew		%d0,R(%a6)
300   clrw		R+2(%a6)
301   movel		%d1,R_Hi(%a6)
302   movel		%d2,R_Lo(%a6)
303   movel		L_SCR1(%a6),%d6
304   movew		%d6,Y(%a6)
305   clrw		Y+2(%a6)
306   movel		%d4,Y_Hi(%a6)
307   movel		%d5,Y_Lo(%a6)
308   fmovex		R(%a6),%fp0		| ...no exception
309   movel		#1,Sc_Flag(%a6)
310   bras		ModOrRem
311No_Scale:
312   movel		%d1,R_Hi(%a6)
313   movel		%d2,R_Lo(%a6)
314   subil		#0x3FFE,%d0
315   movew		%d0,R(%a6)
316   clrw		R+2(%a6)
317   movel		L_SCR1(%a6),%d6
318   subil		#0x3FFE,%d6
319   movel		%d6,L_SCR1(%a6)
320   fmovex		R(%a6),%fp0
321   movew		%d6,Y(%a6)
322   movel		%d4,Y_Hi(%a6)
323   movel		%d5,Y_Lo(%a6)
324   movel		#0,Sc_Flag(%a6)
325
326|
327
328
329ModOrRem:
330   movel               Mod_Flag(%a6),%d6
331   beqs                Fix_Sign
332
333   movel               L_SCR1(%a6),%d6           | ...new biased expo(Y)
334   subql               #1,%d6           | ...biased expo(Y/2)
335   cmpl                %d6,%d0
336   blts                Fix_Sign
337   bgts                Last_Sub
338
339   cmpl                %d4,%d1
340   bnes                Not_EQ
341   cmpl                %d5,%d2
342   bnes                Not_EQ
343   bra                Tie_Case
344
345Not_EQ:
346   bcss                Fix_Sign
347
348Last_Sub:
349|
350   fsubx		Y(%a6),%fp0		| ...no exceptions
351   addql               #1,%d3           | ...Q := Q + 1
352
353|
354
355Fix_Sign:
356|..Get sign of X
357   movew               SignX(%a6),%d6
358   bges		Get_Q
359   fnegx		%fp0
360
361|..Get Q
362|
363Get_Q:
364   clrl		%d6
365   movew               SignQ(%a6),%d6        | ...D6 is sign(Q)
366   movel               #8,%d7
367   lsrl                %d7,%d6
368   andil               #0x0000007F,%d3   | ...7 bits of Q
369   orl                 %d6,%d3           | ...sign and bits of Q
370   swap                 %d3
371   fmovel              %fpsr,%d6
372   andil               #0xFF00FFFF,%d6
373   orl                 %d3,%d6
374   fmovel              %d6,%fpsr         | ...put Q in fpsr
375
376|
377Restore:
378   moveml              (%a7)+,%d2-%d7
379   fmovel              USER_FPCR(%a6),%fpcr
380   movel               Sc_Flag(%a6),%d0
381   beqs                Finish
382   fmulx		Scale(%pc),%fp0	| ...may cause underflow
383   bra			t_avoid_unsupp	|check for denorm as a
384|					;result of the scaling
385
386Finish:
387	fmovex		%fp0,%fp0		|capture exceptions & round
388	rts
389
390Rem_is_0:
391|..R = 2^(-j)X - Q Y = Y, thus R = 0 and quotient = 2^j (Q+1)
392   addql               #1,%d3
393   cmpil               #8,%d0           | ...D0 is j
394   bges                Q_Big
395
396   lsll                %d0,%d3
397   bras                Set_R_0
398
399Q_Big:
400   clrl                %d3
401
402Set_R_0:
403   fmoves		#0x00000000,%fp0
404   movel		#0,Sc_Flag(%a6)
405   bra                Fix_Sign
406
407Tie_Case:
408|..Check parity of Q
409   movel               %d3,%d6
410   andil               #0x00000001,%d6
411   tstl                %d6
412   beq                Fix_Sign	| ...Q is even
413
414|..Q is odd, Q := Q + 1, signX := -signX
415   addql               #1,%d3
416   movew               SignX(%a6),%d6
417   eoril               #0x00008000,%d6
418   movew               %d6,SignX(%a6)
419   bra                Fix_Sign
420
421   |end
422