chiark / gitweb /
Expunge revision histories in files.
[catacomb] / mp-arith.c
1 /* -*-c-*-
2  *
3  * $Id: mp-arith.c,v 1.18 2004/04/08 01:36:15 mdw Exp $
4  *
5  * Basic arithmetic on multiprecision integers
6  *
7  * (c) 1999 Straylight/Edgeware
8  */
9
10 /*----- Licensing notice --------------------------------------------------* 
11  *
12  * This file is part of Catacomb.
13  *
14  * Catacomb is free software; you can redistribute it and/or modify
15  * it under the terms of the GNU Library General Public License as
16  * published by the Free Software Foundation; either version 2 of the
17  * License, or (at your option) any later version.
18  * 
19  * Catacomb is distributed in the hope that it will be useful,
20  * but WITHOUT ANY WARRANTY; without even the implied warranty of
21  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
22  * GNU Library General Public License for more details.
23  * 
24  * You should have received a copy of the GNU Library General Public
25  * License along with Catacomb; if not, write to the Free
26  * Software Foundation, Inc., 59 Temple Place - Suite 330, Boston,
27  * MA 02111-1307, USA.
28  */
29
30 /*----- Header files ------------------------------------------------------*/
31
32 #include "mp.h"
33
34 /*----- Macros ------------------------------------------------------------*/
35
36 #define MAX(x, y) ((x) >= (y) ? (x) : (y))
37
38 /*----- Main code ---------------------------------------------------------*/
39
40 /* --- @mp_lsl@, @mp_lslc@, @mp_lsr@ --- *
41  *
42  * Arguments:   @mp *d@ = destination
43  *              @mp *a@ = source
44  *              @size_t n@ = number of bits to move
45  *
46  * Returns:     Result, @a@ shifted left or right by @n@.
47  *
48  * Use:         Bitwise shift operators.  @mp_lslc@ fills the bits introduced
49  *              on the right with ones instead of zeroes: it's used
50  *              internally by @mp_lsl2c@, though it may be useful on its
51  *              own.
52  */
53
54 mp *mp_lsl(mp *d, mp *a, size_t n)
55 {
56   MP_DEST(d, MP_LEN(a) + (n + MPW_BITS - 1) / MPW_BITS, a->f);
57   mpx_lsl(d->v, d->vl, a->v, a->vl, n);
58   d->f = a->f & (MP_NEG | MP_BURN);
59   MP_SHRINK(d);
60   return (d);
61 }
62
63 mp *mp_lslc(mp *d, mp *a, size_t n)
64 {
65   MP_DEST(d, MP_LEN(a) + (n + MPW_BITS - 1) / MPW_BITS, a->f);
66   mpx_lslc(d->v, d->vl, a->v, a->vl, n);
67   d->f = a->f & (MP_NEG | MP_BURN);
68   MP_SHRINK(d);
69   return (d);
70 }
71
72 mp *mp_lsr(mp *d, mp *a, size_t n)
73 {
74   MP_DEST(d, MP_LEN(a), a->f);
75   mpx_lsr(d->v, d->vl, a->v, a->vl, n);
76   d->f = a->f & (MP_NEG | MP_BURN);
77   MP_SHRINK(d);
78   return (d);
79 }
80
81 /* --- @mp_lsl2c@, @mp_lsr2c@ --- *
82  *
83  * Arguments:   @mp *d@ = destination
84  *              @mp *a@ = source
85  *              @size_t n@ = number of bits to move
86  *
87  * Returns:     Result, @a@ shifted left or right by @n@.  Handles the
88  *              pretence of sign-extension for negative numbers.
89  */
90
91 mp *mp_lsl2c(mp *d, mp *a, size_t n)
92 {
93   if (!(a->f & MP_NEG))
94     return (mp_lsl(d, a, n));
95   d = mp_not2c(d, a);
96   d = mp_lslc(d, d, n);
97   d = mp_not2c(d, d);
98   return (d);
99 }
100
101 mp *mp_lsr2c(mp *d, mp *a, size_t n)
102 {
103   if (!(a->f & MP_NEG))
104     return (mp_lsr(d, a, n));
105   d = mp_not2c(d, a);
106   d = mp_lsr(d, d, n);
107   d = mp_not2c(d, d);
108   return (d);
109 }
110
111 /* --- @mp_testbit@ --- *
112  *
113  * Arguments:   @mp *x@ = a large integer
114  *              @unsigned long n@ = which bit to test
115  *
116  * Returns:     Nonzero if the bit is set, zero if not.
117  */
118
119 int mp_testbit(mp *x, unsigned long n)
120 {
121   if (n > MPW_BITS * MP_LEN(x))
122     return (0);
123   return ((x->v[n/MPW_BITS] >> n%MPW_BITS) & 1u);
124 }
125
126 /* --- @mp_testbit2c@ --- *
127  *
128  * Arguments:   @mp *x@ = a large integer
129  *              @unsigned long n@ = which bit to test
130  *
131  * Returns:     Nonzero if the bit is set, zero if not.  Fakes up two's
132  *              complement representation.
133  */
134
135 int mp_testbit2c(mp *x, unsigned long n)
136 {
137   int r;
138   if (!(x->f & MP_NEG))
139     return (mp_testbit(x, n));
140   x = mp_not2c(MP_NEW, x);
141   r = !mp_testbit(x, n);
142   MP_DROP(x);
143   return (r);
144 }
145
146 /* --- @mp_setbit@, @mp_clearbit@ --- *
147  *
148  * Arguments:   @mp *d@ = a destination
149  *              @mp *x@ = a large integer
150  *              @unsigned long n@ = which bit to modify
151  *
152  * Returns:     The argument @x@, with the appropriate bit set or cleared.
153  */
154
155 mp *mp_setbit(mp *d, mp *x, unsigned long n)
156 {
157   size_t rq;
158
159   rq = n + MPW_BITS; rq -= rq % MPW_BITS;
160   if (d != x) {
161     if (d) MP_DROP(d);
162     d = MP_COPY(x);
163   }
164   MP_DEST(d, rq, x->f & (MP_NEG | MP_BURN));
165   d->v[n/MPW_BITS] |= 1 << n%MPW_BITS;
166   return (d);
167 }
168
169 mp *mp_clearbit(mp *d, mp *x, unsigned long n)
170 {
171   size_t rq;
172
173   rq = n + MPW_BITS; rq -= rq % MPW_BITS;
174   if (d != x) {
175     if (d) MP_DROP(d);
176     d = MP_COPY(x);
177   }
178   MP_DEST(d, rq, x->f & (MP_NEG | MP_BURN));
179   d->v[n/MPW_BITS] &= ~(1 << n%MPW_BITS);
180   return (d);
181 }
182
183 /* --- @mp_setbit2c@, @mp_clearbit2c@ --- *
184  *
185  * Arguments:   @mp *d@ = a destination
186  *              @mp *x@ = a large integer
187  *              @unsigned long n@ = which bit to modify
188  *
189  * Returns:     The argument @x@, with the appropriate bit set or cleared.
190  *              Fakes up two's complement representation.
191  */
192
193 mp *mp_setbit2c(mp *d, mp *x, unsigned long n)
194 {
195   if (!(x->f & MP_NEG))
196     return mp_setbit(d, x, n);
197   d = mp_not2c(d, x);
198   d = mp_clearbit(d, d, n);
199   d = mp_not2c(d, d);
200   return (d);
201 }
202
203 mp *mp_clearbit2c(mp *d, mp *x, unsigned long n)
204 {
205   if (!(x->f & MP_NEG))
206     return mp_clearbit(d, x, n);
207   d = mp_not2c(d, x);
208   d = mp_setbit(d, d, n);
209   d = mp_not2c(d, d);
210   return (d);
211 }
212
213 /* --- @mp_eq@ --- *
214  *
215  * Arguments:   @const mp *a, *b@ = two numbers
216  *
217  * Returns:     Nonzero if the numbers are equal.
218  */
219
220 int mp_eq(const mp *a, const mp *b) { return (MP_EQ(a, b)); }
221
222 /* --- @mp_cmp@ --- *
223  *
224  * Arguments:   @const mp *a, *b@ = two numbers
225  *
226  * Returns:     Less than, equal to or greater than zero, according to
227  *              whether @a@ is less than, equal to or greater than @b@.
228  */
229
230 int mp_cmp(const mp *a, const mp *b)
231 {
232   if (!((a->f ^ b->f) & MP_NEG))
233     return (mpx_ucmp(a->v, a->vl, b->v, b->vl));
234   else if (a->f & MP_NEG)
235     return (-1);
236   else
237     return (+1);
238 }
239
240 /* --- @mp_neg@ --- *
241  *
242  * Arguments:   @mp *d@ = destination
243  *              @mp *a@ = argument
244  *
245  * Returns:     The negation of the argument.
246  *
247  * Use:         Negates its argument.
248  */
249
250 mp *mp_neg(mp *d, mp *a)
251 {
252   /* --- Surprising amounts of messing about required --- */
253
254   MP_SHRINK(a);
255   MP_COPY(a);
256   if (d)
257     MP_DROP(d);
258   if (a->v == a->vl)
259     return (a);
260   MP_DEST(a, MP_LEN(a), a->f);
261   a->f ^= MP_NEG;
262   return (a);
263 }
264
265 /* --- @mp_bitop@ --- *
266  *
267  * Arguments:   @mp *d@ = destination
268  *              @mp *a, *b@ = sources
269  *
270  * Returns:     The result of the given bitwise operation.  These functions
271  *              don't handle negative numbers at all sensibly.  For that, use
272  *              the @...2c@ variants.  The functions are named after the
273  *              truth tables they generate:
274  *
275  *                      a:      0011
276  *                      b:      0101
277  *                      @mpx_bitXXXX@
278  */
279
280 #define MP_BITBINOP(string)                                             \
281                                                                         \
282 mp *mp_bit##string(mp *d, mp *a, mp *b)                                 \
283 {                                                                       \
284   MP_DEST(d, MAX(MP_LEN(a), MP_LEN(b)), (a->f | b->f) & ~MP_NEG);       \
285   mpx_bit##string(d->v, d->vl, a->v, a->vl, b->v, b->vl);               \
286   d->f = (a->f | b->f) & MP_BURN;                                       \
287   MP_SHRINK(d);                                                         \
288   return (d);                                                           \
289 }
290
291 MPX_DOBIN(MP_BITBINOP)
292
293 /* --- @mp_not@ --- *
294  *
295  * Arguments:   @mp *d@ = destination
296  *              @mp *a@ = source
297  *
298  * Returns:     The bitwise complement of the source.
299  */ 
300
301 mp *mp_not(mp *d, mp *a)
302 {
303   MP_DEST(d, MP_LEN(a), a->f);
304   mpx_not(d->v, d->vl, a->v, a->vl);
305   d->f = a->f & MP_BURN;
306   MP_SHRINK(d);
307   return (d);
308 }
309
310 /* --- @mp_bitop2c@ --- *
311  *
312  * Arguments:   @mp *d@ = destination
313  *              @mp *a, *b@ = sources
314  *
315  * Returns:     The result of the given bitwise operation.  Negative numbers
316  *              are treated as two's complement, sign-extended infinitely to
317  *              the left.  The functions are named after the truth tables
318  *              they generate:
319  *
320  *                      a:      0011
321  *                      b:      0101
322  *                      @mpx_bitXXXX@
323  */
324
325 /* --- How this actually works --- *
326  *
327  * The two arguments are inverted (with a sign-swap) if they're currently
328  * negative.  This means that we end up using a different function (one which
329  * reinverts as we go) for the main operation.  Also, if the sign would be
330  * negative at the end, we preinvert the output and then invert again with a
331  * sign-swap.
332  *
333  * Start with:                  wxyz      WXYZ
334  * If @a@ negative:             yzwx  or  YZWX
335  * If @b@ negative:             xwzy      XWZY
336  * If both negative:            zyxw      ZYXW
337  */
338
339 #define MP_BIT2CBINOP(n, base, an, bn, abn, p_base, p_an, p_bn, p_abn)  \
340                                                                         \
341 mp *mp_bit##n##2c(mp *d, mp *a, mp *b)                                  \
342 {                                                                       \
343   if (!((a->f | b->f) & MP_NEG)) {      /* Both positive */             \
344     d = mp_bit##base(d, a, b);                                          \
345     p_base                                                              \
346   } else if (!(b->f & MP_NEG)) {        /* Only @b@ positive */         \
347     MP_COPY(b);                                                         \
348     d = mp_not2c(d, a);                                                 \
349     d = mp_bit##an(d, d, b);                                            \
350     MP_DROP(b);                                                         \
351     p_an                                                                \
352   } else if (!(a->f & MP_NEG)) {        /* Only @a@ positive */         \
353     MP_COPY(a);                                                         \
354     d = mp_not2c(d, b);                                                 \
355     d = mp_bit##bn(d, a, d);                                            \
356     MP_DROP(a);                                                         \
357     p_bn                                                                \
358   } else {                              /* Both negative */             \
359     mp *t = mp_not2c(MP_NEW, a);                                        \
360     mp *d = mp_not2c(d, b);                                             \
361     d = mp_bit##abn(d, t, d);                                           \
362     MP_DROP(t);                                                         \
363     p_abn                                                               \
364   }                                                                     \
365   return (d);                                                           \
366 }                                                                       \
367
368 #define NEG d = mp_not2c(d, d);
369 #define POS
370 MP_BIT2CBINOP(0000, 0000, 0000, 0000, 0000, POS, POS, POS, POS)
371 MP_BIT2CBINOP(0001, 0001, 0100, 0010, 0111, POS, POS, POS, NEG)
372 MP_BIT2CBINOP(0010, 0010, 0111, 0001, 0100, POS, NEG, POS, POS)
373 MP_BIT2CBINOP(0011, 0011, 0011, 0011, 0011, POS, NEG, POS, NEG)
374 MP_BIT2CBINOP(0100, 0100, 0001, 0111, 0010, POS, POS, NEG, POS)
375 MP_BIT2CBINOP(0101, 0101, 0101, 0101, 0101, POS, POS, NEG, NEG)
376 MP_BIT2CBINOP(0110, 0110, 0110, 0110, 0110, POS, NEG, NEG, POS)
377 MP_BIT2CBINOP(0111, 0111, 0010, 0100, 0001, POS, NEG, NEG, NEG)
378 MP_BIT2CBINOP(1000, 0111, 0010, 0100, 0001, NEG, POS, POS, POS)
379 MP_BIT2CBINOP(1001, 0110, 0110, 0110, 0110, NEG, POS, POS, NEG)
380 MP_BIT2CBINOP(1010, 0101, 0101, 0101, 0101, NEG, NEG, POS, POS)
381 MP_BIT2CBINOP(1011, 0100, 0001, 0111, 0010, NEG, NEG, POS, NEG)
382 MP_BIT2CBINOP(1100, 0011, 0011, 0011, 0011, NEG, POS, NEG, POS)
383 MP_BIT2CBINOP(1101, 0010, 0111, 0001, 0100, NEG, POS, NEG, NEG)
384 MP_BIT2CBINOP(1110, 0001, 0100, 0010, 0111, NEG, NEG, NEG, POS)
385 MP_BIT2CBINOP(1111, 0000, 0000, 0000, 0000, NEG, NEG, NEG, NEG)
386 #undef NEG
387 #undef POS
388
389 /* --- @mp_not2c@ --- *
390  *
391  * Arguments:   @mp *d@ = destination
392  *              @mp *a@ = source
393  *
394  * Returns:     The sign-extended complement of the argument.
395  */
396
397 mp *mp_not2c(mp *d, mp *a)
398 {
399   mpw one = 1;
400
401   MP_DEST(d, MP_LEN(a) + 1, a->f);
402   if (d == a) {
403     if (a->f & MP_NEG)
404       MPX_USUBN(d->v, d->vl, 1);
405     else
406       MPX_UADDN(d->v, d->vl, 1);
407   } else {
408     if (a->f & MP_NEG)
409       mpx_usub(d->v, d->vl, a->v, a->vl, &one, &one + 1);
410     else
411       mpx_uadd(d->v, d->vl, a->v, a->vl, &one, &one + 1);
412   }
413   d->f = (a->f & (MP_NEG | MP_BURN)) ^ MP_NEG;
414   MP_SHRINK(d);
415   return (d);
416 }
417
418 /* --- @mp_add@ --- *
419  *
420  * Arguments:   @mp *d@ = destination
421  *              @mp *a, *b@ = sources
422  *
423  * Returns:     Result, @a@ added to @b@.
424  */
425
426 mp *mp_add(mp *d, mp *a, mp *b)
427 {
428   MP_DEST(d, MAX(MP_LEN(a), MP_LEN(b)) + 1, a->f | b->f);
429   if (!((a->f ^ b->f) & MP_NEG))
430     mpx_uadd(d->v, d->vl, a->v, a->vl, b->v, b->vl);
431   else {
432     if (MPX_UCMP(a->v, a->vl, <, b->v, b->vl)) {
433       mp *t = a; a = b; b = t;
434     }
435     mpx_usub(d->v, d->vl, a->v, a->vl, b->v, b->vl);
436   }
437   d->f = ((a->f | b->f) & MP_BURN) | (a->f & MP_NEG);
438   MP_SHRINK(d);
439   return (d);
440 }
441
442 /* --- @mp_sub@ --- *
443  *
444  * Arguments:   @mp *d@ = destination
445  *              @mp *a, *b@ = sources
446  *
447  * Returns:     Result, @b@ subtracted from @a@.
448  */
449
450 mp *mp_sub(mp *d, mp *a, mp *b)
451 {
452   unsigned sgn = 0;
453   MP_DEST(d, MAX(MP_LEN(a), MP_LEN(b)) + 1, a->f | b->f);
454   if ((a->f ^ b->f) & MP_NEG)
455     mpx_uadd(d->v, d->vl, a->v, a->vl, b->v, b->vl);
456   else {
457     if (MPX_UCMP(a->v, a->vl, <, b->v, b->vl)) {
458       mp *t = a; a = b; b = t;
459       sgn = MP_NEG;
460     }
461     mpx_usub(d->v, d->vl, a->v, a->vl, b->v, b->vl);
462   }
463   d->f = ((a->f | b->f) & MP_BURN) | ((a->f ^ sgn) & MP_NEG);
464   MP_SHRINK(d);
465   return (d);
466 }
467
468 /* --- @mp_mul@ --- *
469  *
470  * Arguments:   @mp *d@ = destination
471  *              @mp *a, *b@ = sources
472  *
473  * Returns:     Result, @a@ multiplied by @b@.
474  */
475
476 mp *mp_mul(mp *d, mp *a, mp *b)
477 {
478   a = MP_COPY(a);
479   b = MP_COPY(b);
480
481   if (MP_LEN(a) <= MPK_THRESH || MP_LEN(b) <= MPK_THRESH) {
482     MP_DEST(d, MP_LEN(a) + MP_LEN(b), a->f | b->f | MP_UNDEF);
483     mpx_umul(d->v, d->vl, a->v, a->vl, b->v, b->vl);
484   } else {
485     size_t m = MAX(MP_LEN(a), MP_LEN(b));
486     mpw *s;
487     MP_DEST(d, 3 * m, a->f | b->f | MP_UNDEF);
488     s = mpalloc(d->a, 5 * m);
489     mpx_kmul(d->v, d->vl, a->v, a->vl, b->v, b->vl, s, s + 5 * m);
490     mpfree(d->a, s);
491   }
492
493   d->f = ((a->f | b->f) & MP_BURN) | ((a->f ^ b->f) & MP_NEG);
494   MP_SHRINK(d);
495   MP_DROP(a);
496   MP_DROP(b);
497   return (d);
498 }
499
500 /* --- @mp_sqr@ --- *
501  *
502  * Arguments:   @mp *d@ = destination
503  *              @mp *a@ = source
504  *
505  * Returns:     Result, @a@ squared.
506  */
507
508 mp *mp_sqr(mp *d, mp *a)
509 {
510   size_t m = MP_LEN(a);
511
512   a = MP_COPY(a);
513   if (m > MPK_THRESH) {
514     mpw *s;
515     MP_DEST(d, 3 * m, a->f | MP_UNDEF);
516     s = mpalloc(d->a, 5 * m);
517     mpx_ksqr(d->v, d->vl, a->v, a->vl, s, s + 5 * m);
518     mpfree(d->a, s);
519   } else {
520     MP_DEST(d, 2 * m + 2, a->f | MP_UNDEF);
521     mpx_usqr(d->v, d->vl, a->v, a->vl);
522   }
523   d->f = a->f & MP_BURN;
524   MP_SHRINK(d);
525   MP_DROP(a);
526   return (d);
527 }
528
529 /* --- @mp_div@ --- *
530  *
531  * Arguments:   @mp **qq, **rr@ = destination, quotient and remainder
532  *              @mp *a, *b@ = sources
533  *
534  * Use:         Calculates the quotient and remainder when @a@ is divided by
535  *              @b@.  The destinations @*qq@ and @*rr@ must be distinct.
536  *              Either of @qq@ or @rr@ may be null to indicate that the
537  *              result is irrelevant.  (Discarding both results is silly.)
538  *              There is a performance advantage if @a == *rr@.
539  *
540  *              The behaviour when @a@ and @b@ have the same sign is
541  *              straightforward.  When the signs differ, this implementation
542  *              chooses @r@ to have the same sign as @b@, rather than the
543  *              more normal choice that the remainder has the same sign as
544  *              the dividend.  This makes modular arithmetic a little more
545  *              straightforward.
546  */
547
548 void mp_div(mp **qq, mp **rr, mp *a, mp *b)
549  {
550   mp *r = rr ? *rr : MP_NEW;
551   mp *q = qq ? *qq : MP_NEW;
552   mpw *sv, *svl;
553
554   /* --- Set the remainder up right --- *
555    *
556    * Just in case the divisor is larger, be able to cope with this.  It's not
557    * important in @mpx_udiv@, but it is here because of the sign correction.
558    */
559
560   b = MP_COPY(b);
561   a = MP_COPY(a);
562   if (r)
563     MP_DROP(r);
564   r = a;
565   MP_DEST(r, MAX(MP_LEN(a), MP_LEN(b)) + 2, a->f | b->f);
566
567   /* --- Fix up the quotient too --- */
568
569   r = MP_COPY(r);
570   MP_DEST(q, MP_LEN(r), r->f | MP_UNDEF);
571   MP_DROP(r);
572
573   /* --- Set up some temporary workspace --- */
574
575   {
576     size_t rq = MP_LEN(b) + 1;
577     sv = mpalloc(r->a, rq);
578     svl = sv + rq;
579   }
580
581   /* --- Perform the calculation --- */
582
583   mpx_udiv(q->v, q->vl, r->v, r->vl, b->v, b->vl, sv, svl);
584
585   /* --- Sort out the sign of the results --- *
586    *
587    * If the signs of the arguments differ, and the remainder is nonzero, I
588    * must add one to the absolute value of the quotient and subtract the
589    * remainder from @b@.
590    */
591
592   q->f = ((r->f | b->f) & MP_BURN) | ((r->f ^ b->f) & MP_NEG);
593   if (q->f & MP_NEG) {
594     mpw *v;
595     for (v = r->v; v < r->vl; v++) {
596       if (*v) {
597         MPX_UADDN(q->v, q->vl, 1);
598         mpx_usub(r->v, r->vl, b->v, b->vl, r->v, r->vl);
599         break;
600       }
601     }
602   }
603
604   r->f = ((r->f | b->f) & MP_BURN) | (b->f & MP_NEG);
605
606   /* --- Store the return values --- */
607
608   mpfree(r->a, sv);
609   MP_DROP(b);
610
611   if (!qq)
612     MP_DROP(q);
613   else {
614     MP_SHRINK(q);
615     *qq = q;
616   }
617
618   if (!rr)
619     MP_DROP(r);
620   else {
621     MP_SHRINK(r);
622     *rr = r;
623   }
624 }
625
626 /* --- @mp_odd@ --- *
627  *
628  * Arguments:   @mp *d@ = pointer to destination integer
629  *              @mp *m@ = pointer to source integer
630  *              @size_t *s@ = where to store the power of 2
631  *
632  * Returns:     An odd integer integer %$t$% such that %$m = 2^s t$%.
633  *
634  * Use:         Computes a power of two and an odd integer which, when
635  *              multiplied, give a specified result.  This sort of thing is
636  *              useful in number theory quite often.
637  */
638
639 mp *mp_odd(mp *d, mp *m, size_t *s)
640 {
641   size_t ss = 0;
642   const mpw *v, *vl;
643
644   v = m->v;
645   vl = m->vl;
646   for (; !*v && v < vl; v++)
647     ss += MPW_BITS;
648   if (v >= vl)
649     ss = 0;
650   else {
651     mpw x = *v;
652     mpw mask = MPW_MAX;
653     unsigned z = MPW_BITS / 2;
654
655     while (z) {
656       mask >>= z;
657       if (!(x & mask)) {
658         x >>= z;
659         ss += z;
660       }
661       z >>= 1;
662     }
663   }
664
665   *s = ss;
666   return (mp_lsr(d, m, ss));
667 }
668
669 /*----- Test rig ----------------------------------------------------------*/
670
671 #ifdef TEST_RIG
672
673 static int verify(const char *op, mp *expect, mp *result, mp *a, mp *b)
674 {
675   if (!MP_EQ(expect, result)) {
676     fprintf(stderr, "\n*** %s failed", op);
677     fputs("\n*** a      = ", stderr); mp_writefile(a, stderr, 10);
678     fputs("\n*** b      = ", stderr); mp_writefile(b, stderr, 10);
679     fputs("\n*** result = ", stderr); mp_writefile(result, stderr, 10);
680     fputs("\n*** expect = ", stderr); mp_writefile(expect, stderr, 10);
681     fputc('\n', stderr);
682     return (0);
683   }
684   return (1);
685 }
686
687 #define RIG(name, op)                                                   \
688   static int t##name(dstr *v)                                           \
689   {                                                                     \
690     mp *a = *(mp **)v[0].buf;                                           \
691     mpw n = *(int *)v[1].buf;                                           \
692     mp b;                                                               \
693     mp *r = *(mp **)v[2].buf;                                           \
694     mp *c = op(MP_NEW, a, n);                                           \
695     int ok;                                                             \
696     mp_build(&b, &n, &n + 1);                                           \
697     ok = verify(#name, r, c, a, &b);                                    \
698     mp_drop(a); mp_drop(c); mp_drop(r);                                 \
699     assert(mparena_count(MPARENA_GLOBAL) == 0);                         \
700     return (ok);                                                        \
701   }
702
703 RIG(lsl, mp_lsl)
704 RIG(lsr, mp_lsr)
705 RIG(lsl2c, mp_lsl2c)
706 RIG(lsr2c, mp_lsr2c)
707
708 #undef RIG
709
710 #define RIG(name, op)                                                   \
711   static int t##name(dstr *v)                                           \
712   {                                                                     \
713     mp *a = *(mp **)v[0].buf;                                           \
714     mp *b = *(mp **)v[1].buf;                                           \
715     mp *r = *(mp **)v[2].buf;                                           \
716     mp *c = op(MP_NEW, a, b);                                           \
717     int ok = verify(#name, r, c, a, b);                                 \
718     mp_drop(a); mp_drop(b); mp_drop(c); mp_drop(r);                     \
719     assert(mparena_count(MPARENA_GLOBAL) == 0);                         \
720     return (ok);                                                        \
721   }
722
723 RIG(add, mp_add)
724 RIG(sub, mp_sub)
725 RIG(mul, mp_mul)
726
727 #undef RIG
728
729 static int tdiv(dstr *v)
730 {
731   mp *a = *(mp **)v[0].buf;
732   mp *b = *(mp **)v[1].buf;
733   mp *q = *(mp **)v[2].buf;
734   mp *r = *(mp **)v[3].buf;
735   mp *c = MP_NEW, *d = MP_NEW;
736   int ok = 1;
737   mp_div(&c, &d, a, b);
738   ok &= verify("div(quotient)", q, c, a, b);
739   ok &= verify("div(remainder)", r, d, a, b);
740   mp_drop(a); mp_drop(b); mp_drop(c); mp_drop(d); mp_drop(r); mp_drop(q);
741   assert(mparena_count(MPARENA_GLOBAL) == 0);
742   return (ok);
743 }
744
745 static int tbin(dstr *v)
746 {
747   static mp *(*fn[])(mp *, mp *, mp *) = {
748 #define DO(string) mp_bit##string##2c, 
749 MPX_DOBIN(DO)
750 #undef DO
751   };
752   int ok = 1;
753   unsigned op = 0;
754   mp *a = *(mp **)v[1].buf;
755   mp *b = *(mp **)v[2].buf;
756   mp *r = *(mp **)v[3].buf;
757   mp *c;
758     
759   if (strcmp(v[0].buf, "and") == 0) op = 1;
760   else if (strcmp(v[0].buf, "or") == 0) op = 7;
761   else if (strcmp(v[0].buf, "nand") == 0) op = 14;
762   else if (strcmp(v[0].buf, "nor") == 0) op = 8;
763   else if (strcmp(v[0].buf, "xor") == 0) op = 6;
764   else {
765     char *p = v[0].buf;
766     while (*p) {
767       op <<= 1;
768       if (*p++ == '1')
769         op |= 1;
770     }
771   }
772
773   c = fn[op](MP_NEW, a, b);
774   ok = verify(v[0].buf, r, c, a, b);
775   mp_drop(a); mp_drop(b); mp_drop(r); mp_drop(c);
776   assert(mparena_count(MPARENA_GLOBAL) == 0);
777   return (ok);
778 }
779
780 static int tset(dstr *v)
781 {
782   mp *a = *(mp **)v[0].buf;
783   unsigned long n = *(unsigned long *)v[1].buf;
784   mp *r = *(mp **)v[2].buf;
785   mp *c;
786   int ok = 1;
787
788   c = mp_setbit2c(MP_NEW, a, n);
789   if (!MP_EQ(c, r)) {
790     ok = 0;
791     fprintf(stderr, "\n***setbit (set) failed");
792     fputs("\n*** a  = ", stderr); mp_writefile(a, stderr, 16);
793     fprintf(stderr, "\n*** n  = %lu", n);
794     fputs("\n*** r  = ", stderr); mp_writefile(r, stderr, 16);
795     fputs("\n*** c = ", stderr); mp_writefile(c, stderr, 16);
796     fputc('\n', stderr);
797   }
798   if (!mp_testbit2c(r, n)) {
799     ok = 0;
800     fprintf(stderr, "\n***setbit (test) failed");
801     fprintf(stderr, "\n*** n  = %lu", n);
802     fputs("\n*** r  = ", stderr); mp_writefile(r, stderr, 16);
803     fputc('\n', stderr);
804   }
805   mp_drop(a);
806   mp_drop(r);
807   mp_drop(c);
808   assert(mparena_count(MPARENA_GLOBAL) == 0);
809   return (ok);
810 }
811
812 static int tclr(dstr *v)
813 {
814   mp *a = *(mp **)v[0].buf;
815   unsigned long n = *(unsigned long *)v[1].buf;
816   mp *r = *(mp **)v[2].buf;
817   mp *c;
818   int ok = 1;
819
820   c = mp_clearbit2c(MP_NEW, a, n);
821   if (!MP_EQ(c, r)) {
822     ok = 0;
823     fprintf(stderr, "\n***clrbit (set) failed");
824     fputs("\n*** a  = ", stderr); mp_writefile(a, stderr, 16);
825     fprintf(stderr, "\n*** n  = %lu", n);
826     fputs("\n*** r  = ", stderr); mp_writefile(r, stderr, 16);
827     fputs("\n*** c = ", stderr); mp_writefile(c, stderr, 16);
828     fputc('\n', stderr);
829   }
830   if (mp_testbit2c(r, n)) {
831     ok = 0;
832     fprintf(stderr, "\n***clrbit (test) failed");
833     fprintf(stderr, "\n*** n  = %lu", n);
834     fputs("\n*** r  = ", stderr); mp_writefile(r, stderr, 16);
835     fputc('\n', stderr);
836   }
837   mp_drop(a);
838   mp_drop(c);
839   mp_drop(r);
840   assert(mparena_count(MPARENA_GLOBAL) == 0);
841   return (ok);
842 }
843
844 static int tneg(dstr *v)
845 {
846   mp *a = *(mp **)v[0].buf;
847   mp *r = *(mp **)v[1].buf;
848   int ok = 1;
849   mp *n = mp_neg(MP_NEW, a);
850   if (!MP_EQ(r, n)) {
851     ok = 0;
852     fprintf(stderr, "\n*** neg failed\n");
853     fputs("\n*** a  = ", stderr); mp_writefile(a, stderr, 10);
854     fputs("\n*** r  = ", stderr); mp_writefile(r, stderr, 10);
855     fputs("\n*** n  = ", stderr); mp_writefile(n, stderr, 10);
856     fputc('\n', stderr);
857   }
858   mp_drop(n);
859   n = mp_neg(a, a);
860   if (!MP_EQ(r, n)) {
861     ok = 0;
862     fprintf(stderr, "\n*** neg failed\n");
863     fputs("\n*** a* = ", stderr); mp_writefile(a, stderr, 10);
864     fputs("\n*** r  = ", stderr); mp_writefile(r, stderr, 10);
865     fputs("\n*** n  = ", stderr); mp_writefile(n, stderr, 10);
866     fputc('\n', stderr);
867   }
868   mp_drop(a);
869   mp_drop(r);
870   assert(mparena_count(MPARENA_GLOBAL) == 0);
871   return (ok);  
872 }
873
874 static int todd(dstr *v)
875 {
876   mp *a = *(mp **)v[0].buf;
877   size_t rs = *(uint32 *)v[1].buf;
878   mp *rt = *(mp **)v[2].buf;
879   int ok = 1;
880   mp *t;
881   size_t s;
882   t = mp_odd(MP_NEW, a, &s);
883   if (s != rs || !MP_EQ(t, rt)) {
884     ok = 0;
885     fprintf(stderr, "\n*** odd failed");
886     fputs("\n*** a  = ", stderr); mp_writefile(a, stderr, 10);
887     fprintf(stderr, "\n*** s  = %lu", (unsigned long)s);
888     fputs("\n*** t  = ", stderr); mp_writefile(t, stderr, 10);
889     fprintf(stderr, "\n*** rs = %lu", (unsigned long)rs);
890     fputs("\n*** rt = ", stderr); mp_writefile(rt, stderr, 10);
891     fputc('\n', stderr);
892   }
893   mp_drop(a);
894   mp_drop(rt);
895   mp_drop(t);
896   assert(mparena_count(MPARENA_GLOBAL) == 0);
897   return (ok);
898 }
899
900 static test_chunk tests[] = {
901   { "lsl", tlsl, { &type_mp, &type_int, &type_mp, 0 } },
902   { "lsr", tlsr, { &type_mp, &type_int, &type_mp, 0 } },
903   { "lsl2c", tlsl2c, { &type_mp, &type_int, &type_mp, 0 } },
904   { "lsr2c", tlsr2c, { &type_mp, &type_int, &type_mp, 0 } },
905   { "setbit", tset, { &type_mp, &type_ulong, &type_mp, 0 } },
906   { "clrbit", tclr, { &type_mp, &type_ulong, &type_mp, 0 } },
907   { "add", tadd, { &type_mp, &type_mp, &type_mp, 0 } },
908   { "sub", tsub, { &type_mp, &type_mp, &type_mp, 0 } },
909   { "mul", tmul, { &type_mp, &type_mp, &type_mp, 0 } },
910   { "div", tdiv, { &type_mp, &type_mp, &type_mp, &type_mp, 0 } },
911   { "bin2c", tbin, { &type_string, &type_mp, &type_mp, &type_mp, 0 } },
912   { "odd", todd, { &type_mp, &type_uint32, &type_mp, 0 } },
913   { "neg", tneg, { &type_mp, &type_mp, 0 } },
914   { 0, 0, { 0 } },
915 };
916
917 int main(int argc, char *argv[])
918 {
919   sub_init();
920   test_run(argc, argv, tests, SRCDIR "/tests/mp");
921   return (0);
922 }
923
924 #endif
925
926 /*----- That's all, folks -------------------------------------------------*/