1
2
3
4#include <math-emu/soft-fp.h>
5
6#undef count_leading_zeros
7#define count_leading_zeros __FP_CLZ
8
9void
10_fp_udivmodti4(_FP_W_TYPE q[2], _FP_W_TYPE r[2],
11 _FP_W_TYPE n1, _FP_W_TYPE n0,
12 _FP_W_TYPE d1, _FP_W_TYPE d0)
13{
14 _FP_W_TYPE q0, q1, r0, r1;
15 _FP_I_TYPE b, bm;
16
17 if (d1 == 0)
18 {
19#if !UDIV_NEEDS_NORMALIZATION
20 if (d0 > n1)
21 {
22
23
24 udiv_qrnnd (q0, n0, n1, n0, d0);
25 q1 = 0;
26
27
28 }
29 else
30 {
31
32
33 if (d0 == 0)
34 d0 = 1 / d0;
35
36 udiv_qrnnd (q1, n1, 0, n1, d0);
37 udiv_qrnnd (q0, n0, n1, n0, d0);
38
39
40 }
41
42 r0 = n0;
43 r1 = 0;
44
45#else
46
47 if (d0 > n1)
48 {
49
50
51 count_leading_zeros (bm, d0);
52
53 if (bm != 0)
54 {
55
56
57
58 d0 = d0 << bm;
59 n1 = (n1 << bm) | (n0 >> (_FP_W_TYPE_SIZE - bm));
60 n0 = n0 << bm;
61 }
62
63 udiv_qrnnd (q0, n0, n1, n0, d0);
64 q1 = 0;
65
66
67 }
68 else
69 {
70
71
72 if (d0 == 0)
73 d0 = 1 / d0;
74
75 count_leading_zeros (bm, d0);
76
77 if (bm == 0)
78 {
79
80
81
82
83
84
85
86 n1 -= d0;
87 q1 = 1;
88 }
89 else
90 {
91 _FP_W_TYPE n2;
92
93
94
95 b = _FP_W_TYPE_SIZE - bm;
96
97 d0 = d0 << bm;
98 n2 = n1 >> b;
99 n1 = (n1 << bm) | (n0 >> b);
100 n0 = n0 << bm;
101
102 udiv_qrnnd (q1, n1, n2, n1, d0);
103 }
104
105
106
107 udiv_qrnnd (q0, n0, n1, n0, d0);
108
109
110 }
111
112 r0 = n0 >> bm;
113 r1 = 0;
114#endif
115 }
116 else
117 {
118 if (d1 > n1)
119 {
120
121
122 q0 = 0;
123 q1 = 0;
124
125
126 r0 = n0;
127 r1 = n1;
128 }
129 else
130 {
131
132
133 count_leading_zeros (bm, d1);
134 if (bm == 0)
135 {
136
137
138
139
140
141
142
143
144 if (n1 > d1 || n0 >= d0)
145 {
146 q0 = 1;
147 sub_ddmmss (n1, n0, n1, n0, d1, d0);
148 }
149 else
150 q0 = 0;
151
152 q1 = 0;
153
154 r0 = n0;
155 r1 = n1;
156 }
157 else
158 {
159 _FP_W_TYPE m1, m0, n2;
160
161
162
163 b = _FP_W_TYPE_SIZE - bm;
164
165 d1 = (d1 << bm) | (d0 >> b);
166 d0 = d0 << bm;
167 n2 = n1 >> b;
168 n1 = (n1 << bm) | (n0 >> b);
169 n0 = n0 << bm;
170
171 udiv_qrnnd (q0, n1, n2, n1, d1);
172 umul_ppmm (m1, m0, q0, d0);
173
174 if (m1 > n1 || (m1 == n1 && m0 > n0))
175 {
176 q0--;
177 sub_ddmmss (m1, m0, m1, m0, d1, d0);
178 }
179
180 q1 = 0;
181
182
183 sub_ddmmss (n1, n0, n1, n0, m1, m0);
184 r0 = (n1 << b) | (n0 >> bm);
185 r1 = n1 >> bm;
186 }
187 }
188 }
189
190 q[0] = q0; q[1] = q1;
191 r[0] = r0, r[1] = r1;
192}
193