chiark - git - mdw - catacomb/blob - mp-arith.c

   1 /* -*-c-*-
   2  *
   3  * $Id$
   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 (!MP_NEGP(a))
  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 (!MP_NEGP(a))
 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 (!MP_NEGP(x))
 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 (!MP_NEGP(x))
 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 (!MP_NEGP(x))
 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     if (a->f & MP_NEG)
 234       return (-mpx_ucmp(a->v, a->vl, b->v, b->vl));
 235     else
 236       return (mpx_ucmp(a->v, a->vl, b->v, b->vl));
 237   } else if (a->f & MP_NEG)
 238     return (-1);
 239   else
 240     return (+1);
 241 }
 242
 243 /* --- @mp_neg@ --- *
 244  *
 245  * Arguments:   @mp *d@ = destination
 246  *              @mp *a@ = argument
 247  *
 248  * Returns:     The negation of the argument.
 249  *
 250  * Use:         Negates its argument.
 251  */
 252
 253 mp *mp_neg(mp *d, mp *a)
 254 {
 255   /* --- Surprising amounts of messing about required --- */
 256
 257   MP_SHRINK(a);
 258   MP_COPY(a);
 259   if (d)
 260     MP_DROP(d);
 261   if (a->v == a->vl)
 262     return (a);
 263   MP_DEST(a, MP_LEN(a), a->f);
 264   a->f ^= MP_NEG;
 265   return (a);
 266 }
 267
 268 /* --- @mp_bitop@ --- *
 269  *
 270  * Arguments:   @mp *d@ = destination
 271  *              @mp *a, *b@ = sources
 272  *
 273  * Returns:     The result of the given bitwise operation.  These functions
 274  *              don't handle negative numbers at all sensibly.  For that, use
 275  *              the @...2c@ variants.  The functions are named after the
 276  *              truth tables they generate:
 277  *
 278  *                      a:      0011
 279  *                      b:      0101
 280  *                      @mpx_bitXXXX@
 281  */
 282
 283 #define MP_BITBINOP(string)                                             \
 284                                                                         \
 285 mp *mp_bit##string(mp *d, mp *a, mp *b)                                 \
 286 {                                                                       \
 287   MP_DEST(d, MAX(MP_LEN(a), MP_LEN(b)), (a->f | b->f) & ~MP_NEG);       \
 288   mpx_bit##string(d->v, d->vl, a->v, a->vl, b->v, b->vl);               \
 289   d->f = (a->f | b->f) & MP_BURN;                                       \
 290   MP_SHRINK(d);                                                         \
 291   return (d);                                                           \
 292 }
 293
 294 MPX_DOBIN(MP_BITBINOP)
 295
 296 /* --- @mp_not@ --- *
 297  *
 298  * Arguments:   @mp *d@ = destination
 299  *              @mp *a@ = source
 300  *
 301  * Returns:     The bitwise complement of the source.
 302  */
 303
 304 mp *mp_not(mp *d, mp *a)
 305 {
 306   MP_DEST(d, MP_LEN(a), a->f);
 307   mpx_not(d->v, d->vl, a->v, a->vl);
 308   d->f = a->f & MP_BURN;
 309   MP_SHRINK(d);
 310   return (d);
 311 }
 312
 313 /* --- @mp_bitop2c@ --- *
 314  *
 315  * Arguments:   @mp *d@ = destination
 316  *              @mp *a, *b@ = sources
 317  *
 318  * Returns:     The result of the given bitwise operation.  Negative numbers
 319  *              are treated as two's complement, sign-extended infinitely to
 320  *              the left.  The functions are named after the truth tables
 321  *              they generate:
 322  *
 323  *                      a:      0011
 324  *                      b:      0101
 325  *                      @mpx_bitXXXX@
 326  */
 327
 328 /* --- How this actually works --- *
 329  *
 330  * The two arguments are inverted (with a sign-swap) if they're currently
 331  * negative.  This means that we end up using a different function (one which
 332  * reinverts as we go) for the main operation.  Also, if the sign would be
 333  * negative at the end, we preinvert the output and then invert again with a
 334  * sign-swap.
 335  *
 336  * Start with:                  wxyz      WXYZ
 337  * If @a@ negative:             yzwx  or  YZWX
 338  * If @b@ negative:             xwzy      XWZY
 339  * If both negative:            zyxw      ZYXW
 340  */
 341
 342 #define MP_BIT2CBINOP(n, base, an, bn, abn, p_base, p_an, p_bn, p_abn)  \
 343                                                                         \
 344 mp *mp_bit##n##2c(mp *d, mp *a, mp *b)                                  \
 345 {                                                                       \
 346   if (!((a->f | b->f) & MP_NEG)) {      /* Both positive */             \
 347     d = mp_bit##base(d, a, b);                                          \
 348     p_base                                                              \
 349   } else if (!(b->f & MP_NEG)) {        /* Only @b@ positive */         \
 350     MP_COPY(b);                                                         \
 351     d = mp_not2c(d, a);                                                 \
 352     d = mp_bit##an(d, d, b);                                            \
 353     MP_DROP(b);                                                         \
 354     p_an                                                                \
 355   } else if (!(a->f & MP_NEG)) {        /* Only @a@ positive */         \
 356     MP_COPY(a);                                                         \
 357     d = mp_not2c(d, b);                                                 \
 358     d = mp_bit##bn(d, a, d);                                            \
 359     MP_DROP(a);                                                         \
 360     p_bn                                                                \
 361   } else {                              /* Both negative */             \
 362     mp *t = mp_not2c(MP_NEW, a);                                        \
 363     mp *d = mp_not2c(d, b);                                             \
 364     d = mp_bit##abn(d, t, d);                                           \
 365     MP_DROP(t);                                                         \
 366     p_abn                                                               \
 367   }                                                                     \
 368   return (d);                                                           \
 369 }                                                                       \
 370
 371 #define NEG d = mp_not2c(d, d);
 372 #define POS
 373 MP_BIT2CBINOP(0000, 0000, 0000, 0000, 0000, POS, POS, POS, POS)
 374 MP_BIT2CBINOP(0001, 0001, 0100, 0010, 0111, POS, POS, POS, NEG)
 375 MP_BIT2CBINOP(0010, 0010, 0111, 0001, 0100, POS, NEG, POS, POS)
 376 MP_BIT2CBINOP(0011, 0011, 0011, 0011, 0011, POS, NEG, POS, NEG)
 377 MP_BIT2CBINOP(0100, 0100, 0001, 0111, 0010, POS, POS, NEG, POS)
 378 MP_BIT2CBINOP(0101, 0101, 0101, 0101, 0101, POS, POS, NEG, NEG)
 379 MP_BIT2CBINOP(0110, 0110, 0110, 0110, 0110, POS, NEG, NEG, POS)
 380 MP_BIT2CBINOP(0111, 0111, 0010, 0100, 0001, POS, NEG, NEG, NEG)
 381 MP_BIT2CBINOP(1000, 0111, 0010, 0100, 0001, NEG, POS, POS, POS)
 382 MP_BIT2CBINOP(1001, 0110, 0110, 0110, 0110, NEG, POS, POS, NEG)
 383 MP_BIT2CBINOP(1010, 0101, 0101, 0101, 0101, NEG, NEG, POS, POS)
 384 MP_BIT2CBINOP(1011, 0100, 0001, 0111, 0010, NEG, NEG, POS, NEG)
 385 MP_BIT2CBINOP(1100, 0011, 0011, 0011, 0011, NEG, POS, NEG, POS)
 386 MP_BIT2CBINOP(1101, 0010, 0111, 0001, 0100, NEG, POS, NEG, NEG)
 387 MP_BIT2CBINOP(1110, 0001, 0100, 0010, 0111, NEG, NEG, NEG, POS)
 388 MP_BIT2CBINOP(1111, 0000, 0000, 0000, 0000, NEG, NEG, NEG, NEG)
 389 #undef NEG
 390 #undef POS
 391
 392 /* --- @mp_not2c@ --- *
 393  *
 394  * Arguments:   @mp *d@ = destination
 395  *              @mp *a@ = source
 396  *
 397  * Returns:     The sign-extended complement of the argument.
 398  */
 399
 400 mp *mp_not2c(mp *d, mp *a)
 401 {
 402   mpw one = 1;
 403
 404   MP_DEST(d, MP_LEN(a) + 1, a->f);
 405   if (d == a) {
 406     if (MP_NEGP(a))
 407       MPX_USUBN(d->v, d->vl, 1);
 408     else
 409       MPX_UADDN(d->v, d->vl, 1);
 410   } else {
 411     if (MP_NEGP(a))
 412       mpx_usub(d->v, d->vl, a->v, a->vl, &one, &one + 1);
 413     else
 414       mpx_uadd(d->v, d->vl, a->v, a->vl, &one, &one + 1);
 415   }
 416   d->f = (a->f & (MP_NEG | MP_BURN)) ^ MP_NEG;
 417   MP_SHRINK(d);
 418   return (d);
 419 }
 420
 421 /* --- @mp_add@ --- *
 422  *
 423  * Arguments:   @mp *d@ = destination
 424  *              @mp *a, *b@ = sources
 425  *
 426  * Returns:     Result, @a@ added to @b@.
 427  */
 428
 429 mp *mp_add(mp *d, mp *a, mp *b)
 430 {
 431   MP_DEST(d, MAX(MP_LEN(a), MP_LEN(b)) + 1, a->f | b->f);
 432   if (!((a->f ^ b->f) & MP_NEG))
 433     mpx_uadd(d->v, d->vl, a->v, a->vl, b->v, b->vl);
 434   else {
 435     if (MPX_UCMP(a->v, a->vl, <, b->v, b->vl)) {
 436       mp *t = a; a = b; b = t;
 437     }
 438     mpx_usub(d->v, d->vl, a->v, a->vl, b->v, b->vl);
 439   }
 440   d->f = ((a->f | b->f) & MP_BURN) | (a->f & MP_NEG);
 441   MP_SHRINK(d);
 442   return (d);
 443 }
 444
 445 /* --- @mp_sub@ --- *
 446  *
 447  * Arguments:   @mp *d@ = destination
 448  *              @mp *a, *b@ = sources
 449  *
 450  * Returns:     Result, @b@ subtracted from @a@.
 451  */
 452
 453 mp *mp_sub(mp *d, mp *a, mp *b)
 454 {
 455   unsigned sgn = 0;
 456   MP_DEST(d, MAX(MP_LEN(a), MP_LEN(b)) + 1, a->f | b->f);
 457   if ((a->f ^ b->f) & MP_NEG)
 458     mpx_uadd(d->v, d->vl, a->v, a->vl, b->v, b->vl);
 459   else {
 460     if (MPX_UCMP(a->v, a->vl, <, b->v, b->vl)) {
 461       mp *t = a; a = b; b = t;
 462       sgn = MP_NEG;
 463     }
 464     mpx_usub(d->v, d->vl, a->v, a->vl, b->v, b->vl);
 465   }
 466   d->f = ((a->f | b->f) & MP_BURN) | ((a->f ^ sgn) & MP_NEG);
 467   MP_SHRINK(d);
 468   return (d);
 469 }
 470
 471 /* --- @mp_mul@ --- *
 472  *
 473  * Arguments:   @mp *d@ = destination
 474  *              @mp *a, *b@ = sources
 475  *
 476  * Returns:     Result, @a@ multiplied by @b@.
 477  */
 478
 479 mp *mp_mul(mp *d, mp *a, mp *b)
 480 {
 481   a = MP_COPY(a);
 482   b = MP_COPY(b);
 483
 484   if (MP_LEN(a) <= MPK_THRESH || MP_LEN(b) <= MPK_THRESH) {
 485     MP_DEST(d, MP_LEN(a) + MP_LEN(b), a->f | b->f | MP_UNDEF);
 486     mpx_umul(d->v, d->vl, a->v, a->vl, b->v, b->vl);
 487   } else {
 488     size_t m = MAX(MP_LEN(a), MP_LEN(b));
 489     mpw *s;
 490     MP_DEST(d, 3 * m, a->f | b->f | MP_UNDEF);
 491     s = mpalloc(d->a, 5 * m);
 492     mpx_kmul(d->v, d->vl, a->v, a->vl, b->v, b->vl, s, s + 5 * m);
 493     mpfree(d->a, s);
 494   }
 495
 496   d->f = ((a->f | b->f) & MP_BURN) | ((a->f ^ b->f) & MP_NEG);
 497   MP_SHRINK(d);
 498   MP_DROP(a);
 499   MP_DROP(b);
 500   return (d);
 501 }
 502
 503 /* --- @mp_sqr@ --- *
 504  *
 505  * Arguments:   @mp *d@ = destination
 506  *              @mp *a@ = source
 507  *
 508  * Returns:     Result, @a@ squared.
 509  */
 510
 511 mp *mp_sqr(mp *d, mp *a)
 512 {
 513   size_t m = MP_LEN(a);
 514
 515   a = MP_COPY(a);
 516   if (m > MPK_THRESH) {
 517     mpw *s;
 518     MP_DEST(d, 3 * m, a->f | MP_UNDEF);
 519     s = mpalloc(d->a, 5 * m);
 520     mpx_ksqr(d->v, d->vl, a->v, a->vl, s, s + 5 * m);
 521     mpfree(d->a, s);
 522   } else {
 523     MP_DEST(d, 2 * m + 2, a->f | MP_UNDEF);
 524     mpx_usqr(d->v, d->vl, a->v, a->vl);
 525   }
 526   d->f = a->f & MP_BURN;
 527   MP_SHRINK(d);
 528   MP_DROP(a);
 529   return (d);
 530 }
 531
 532 /* --- @mp_div@ --- *
 533  *
 534  * Arguments:   @mp **qq, **rr@ = destination, quotient and remainder
 535  *              @mp *a, *b@ = sources
 536  *
 537  * Use:         Calculates the quotient and remainder when @a@ is divided by
 538  *              @b@.  The destinations @*qq@ and @*rr@ must be distinct.
 539  *              Either of @qq@ or @rr@ may be null to indicate that the
 540  *              result is irrelevant.  (Discarding both results is silly.)
 541  *              There is a performance advantage if @a == *rr@.
 542  *
 543  *              The behaviour when @a@ and @b@ have the same sign is
 544  *              straightforward.  When the signs differ, this implementation
 545  *              chooses @r@ to have the same sign as @b@, rather than the
 546  *              more normal choice that the remainder has the same sign as
 547  *              the dividend.  This makes modular arithmetic a little more
 548  *              straightforward.
 549  */
 550
 551 void mp_div(mp **qq, mp **rr, mp *a, mp *b)
 552  {
 553   mp *r = rr ? *rr : MP_NEW;
 554   mp *q = qq ? *qq : MP_NEW;
 555   mpw *sv, *svl;
 556
 557   /* --- Set the remainder up right --- *
 558    *
 559    * Just in case the divisor is larger, be able to cope with this.  It's not
 560    * important in @mpx_udiv@, but it is here because of the sign correction.
 561    */
 562
 563   b = MP_COPY(b);
 564   a = MP_COPY(a);
 565   if (r)
 566     MP_DROP(r);
 567   r = a;
 568   MP_DEST(r, MAX(MP_LEN(a), MP_LEN(b)) + 2, a->f | b->f);
 569
 570   /* --- Fix up the quotient too --- */
 571
 572   r = MP_COPY(r);
 573   MP_DEST(q, MP_LEN(r), r->f | MP_UNDEF);
 574   MP_DROP(r);
 575
 576   /* --- Set up some temporary workspace --- */
 577
 578   {
 579     size_t rq = MP_LEN(b) + 1;
 580     sv = mpalloc(r->a, rq);
 581     svl = sv + rq;
 582   }
 583
 584   /* --- Perform the calculation --- */
 585
 586   mpx_udiv(q->v, q->vl, r->v, r->vl, b->v, b->vl, sv, svl);
 587
 588   /* --- Sort out the sign of the results --- *
 589    *
 590    * If the signs of the arguments differ, and the remainder is nonzero, I
 591    * must add one to the absolute value of the quotient and subtract the
 592    * remainder from @b@.
 593    */
 594
 595   q->f = ((r->f | b->f) & MP_BURN) | ((r->f ^ b->f) & MP_NEG);
 596   if (MP_NEGP(q)) {
 597     mpw *v;
 598     for (v = r->v; v < r->vl; v++) {
 599       if (*v) {
 600         MPX_UADDN(q->v, q->vl, 1);
 601         mpx_usub(r->v, r->vl, b->v, b->vl, r->v, r->vl);
 602         break;
 603       }
 604     }
 605   }
 606
 607   r->f = ((r->f | b->f) & MP_BURN) | (b->f & MP_NEG);
 608
 609   /* --- Store the return values --- */
 610
 611   mpfree(r->a, sv);
 612   MP_DROP(b);
 613
 614   if (!qq)
 615     MP_DROP(q);
 616   else {
 617     MP_SHRINK(q);
 618     *qq = q;
 619   }
 620
 621   if (!rr)
 622     MP_DROP(r);
 623   else {
 624     MP_SHRINK(r);
 625     *rr = r;
 626   }
 627 }
 628
 629 /* --- @mp_odd@ --- *
 630  *
 631  * Arguments:   @mp *d@ = pointer to destination integer
 632  *              @mp *m@ = pointer to source integer
 633  *              @size_t *s@ = where to store the power of 2
 634  *
 635  * Returns:     An odd integer integer %$t$% such that %$m = 2^s t$%.
 636  *
 637  * Use:         Computes a power of two and an odd integer which, when
 638  *              multiplied, give a specified result.  This sort of thing is
 639  *              useful in number theory quite often.
 640  */
 641
 642 mp *mp_odd(mp *d, mp *m, size_t *s)
 643 {
 644   size_t ss = 0;
 645   const mpw *v, *vl;
 646
 647   v = m->v;
 648   vl = m->vl;
 649   for (; !*v && v < vl; v++)
 650     ss += MPW_BITS;
 651   if (v >= vl)
 652     ss = 0;
 653   else {
 654     mpw x = *v;
 655     mpw mask = MPW_MAX;
 656     unsigned z = MPW_BITS / 2;
 657
 658     while (z) {
 659       mask >>= z;
 660       if (!(x & mask)) {
 661         x >>= z;
 662         ss += z;
 663       }
 664       z >>= 1;
 665     }
 666   }
 667
 668   *s = ss;
 669   return (mp_lsr(d, m, ss));
 670 }
 671
 672 /*----- Test rig ----------------------------------------------------------*/
 673
 674 #ifdef TEST_RIG
 675
 676 static int verify(const char *op, mp *expect, mp *result, mp *a, mp *b)
 677 {
 678   if (!MP_EQ(expect, result)) {
 679     fprintf(stderr, "\n*** %s failed", op);
 680     fputs("\n*** a      = ", stderr); mp_writefile(a, stderr, 10);
 681     fputs("\n*** b      = ", stderr); mp_writefile(b, stderr, 10);
 682     fputs("\n*** result = ", stderr); mp_writefile(result, stderr, 10);
 683     fputs("\n*** expect = ", stderr); mp_writefile(expect, stderr, 10);
 684     fputc('\n', stderr);
 685     return (0);
 686   }
 687   return (1);
 688 }
 689
 690 #define RIG(name, op)                                                   \
 691   static int t##name(dstr *v)                                           \
 692   {                                                                     \
 693     mp *a = *(mp **)v[0].buf;                                           \
 694     mpw n = *(int *)v[1].buf;                                           \
 695     mp b;                                                               \
 696     mp *r = *(mp **)v[2].buf;                                           \
 697     mp *c = op(MP_NEW, a, n);                                           \
 698     int ok;                                                             \
 699     mp_build(&b, &n, &n + 1);                                           \
 700     ok = verify(#name, r, c, a, &b);                                    \
 701     mp_drop(a); mp_drop(c); mp_drop(r);                                 \
 702     assert(mparena_count(MPARENA_GLOBAL) == 0);                         \
 703     return (ok);                                                        \
 704   }
 705
 706 RIG(lsl, mp_lsl)
 707 RIG(lsr, mp_lsr)
 708 RIG(lsl2c, mp_lsl2c)
 709 RIG(lsr2c, mp_lsr2c)
 710
 711 #undef RIG
 712
 713 #define RIG(name, op)                                                   \
 714   static int t##name(dstr *v)                                           \
 715   {                                                                     \
 716     mp *a = *(mp **)v[0].buf;                                           \
 717     mp *b = *(mp **)v[1].buf;                                           \
 718     mp *r = *(mp **)v[2].buf;                                           \
 719     mp *c = op(MP_NEW, a, b);                                           \
 720     int ok = verify(#name, r, c, a, b);                                 \
 721     mp_drop(a); mp_drop(b); mp_drop(c); mp_drop(r);                     \
 722     assert(mparena_count(MPARENA_GLOBAL) == 0);                         \
 723     return (ok);                                                        \
 724   }
 725
 726 RIG(add, mp_add)
 727 RIG(sub, mp_sub)
 728 RIG(mul, mp_mul)
 729 RIG(exp, mp_exp)
 730
 731 #undef RIG
 732
 733 static int tdiv(dstr *v)
 734 {
 735   mp *a = *(mp **)v[0].buf;
 736   mp *b = *(mp **)v[1].buf;
 737   mp *q = *(mp **)v[2].buf;
 738   mp *r = *(mp **)v[3].buf;
 739   mp *c = MP_NEW, *d = MP_NEW;
 740   int ok = 1;
 741   mp_div(&c, &d, a, b);
 742   ok &= verify("div(quotient)", q, c, a, b);
 743   ok &= verify("div(remainder)", r, d, a, b);
 744   mp_drop(a); mp_drop(b); mp_drop(c); mp_drop(d); mp_drop(r); mp_drop(q);
 745   assert(mparena_count(MPARENA_GLOBAL) == 0);
 746   return (ok);
 747 }
 748
 749 static int tbin(dstr *v)
 750 {
 751   static mp *(*fn[])(mp *, mp *, mp *) = {
 752 #define DO(string) mp_bit##string##2c,
 753 MPX_DOBIN(DO)
 754 #undef DO
 755   };
 756   int ok = 1;
 757   unsigned op = 0;
 758   mp *a = *(mp **)v[1].buf;
 759   mp *b = *(mp **)v[2].buf;
 760   mp *r = *(mp **)v[3].buf;
 761   mp *c;
 762
 763   if (strcmp(v[0].buf, "and") == 0) op = 1;
 764   else if (strcmp(v[0].buf, "or") == 0) op = 7;
 765   else if (strcmp(v[0].buf, "nand") == 0) op = 14;
 766   else if (strcmp(v[0].buf, "nor") == 0) op = 8;
 767   else if (strcmp(v[0].buf, "xor") == 0) op = 6;
 768   else {
 769     char *p = v[0].buf;
 770     while (*p) {
 771       op <<= 1;
 772       if (*p++ == '1')
 773         op |= 1;
 774     }
 775   }
 776
 777   c = fn[op](MP_NEW, a, b);
 778   ok = verify(v[0].buf, r, c, a, b);
 779   mp_drop(a); mp_drop(b); mp_drop(r); mp_drop(c);
 780   assert(mparena_count(MPARENA_GLOBAL) == 0);
 781   return (ok);
 782 }
 783
 784 static int tset(dstr *v)
 785 {
 786   mp *a = *(mp **)v[0].buf;
 787   unsigned long n = *(unsigned long *)v[1].buf;
 788   mp *r = *(mp **)v[2].buf;
 789   mp *c;
 790   int ok = 1;
 791
 792   c = mp_setbit2c(MP_NEW, a, n);
 793   if (!MP_EQ(c, r)) {
 794     ok = 0;
 795     fprintf(stderr, "\n***setbit (set) failed");
 796     fputs("\n*** a  = ", stderr); mp_writefile(a, stderr, 16);
 797     fprintf(stderr, "\n*** n  = %lu", n);
 798     fputs("\n*** r  = ", stderr); mp_writefile(r, stderr, 16);
 799     fputs("\n*** c = ", stderr); mp_writefile(c, stderr, 16);
 800     fputc('\n', stderr);
 801   }
 802   if (!mp_testbit2c(r, n)) {
 803     ok = 0;
 804     fprintf(stderr, "\n***setbit (test) failed");
 805     fprintf(stderr, "\n*** n  = %lu", n);
 806     fputs("\n*** r  = ", stderr); mp_writefile(r, stderr, 16);
 807     fputc('\n', stderr);
 808   }
 809   mp_drop(a);
 810   mp_drop(r);
 811   mp_drop(c);
 812   assert(mparena_count(MPARENA_GLOBAL) == 0);
 813   return (ok);
 814 }
 815
 816 static int tclr(dstr *v)
 817 {
 818   mp *a = *(mp **)v[0].buf;
 819   unsigned long n = *(unsigned long *)v[1].buf;
 820   mp *r = *(mp **)v[2].buf;
 821   mp *c;
 822   int ok = 1;
 823
 824   c = mp_clearbit2c(MP_NEW, a, n);
 825   if (!MP_EQ(c, r)) {
 826     ok = 0;
 827     fprintf(stderr, "\n***clrbit (set) failed");
 828     fputs("\n*** a  = ", stderr); mp_writefile(a, stderr, 16);
 829     fprintf(stderr, "\n*** n  = %lu", n);
 830     fputs("\n*** r  = ", stderr); mp_writefile(r, stderr, 16);
 831     fputs("\n*** c = ", stderr); mp_writefile(c, stderr, 16);
 832     fputc('\n', stderr);
 833   }
 834   if (mp_testbit2c(r, n)) {
 835     ok = 0;
 836     fprintf(stderr, "\n***clrbit (test) failed");
 837     fprintf(stderr, "\n*** n  = %lu", n);
 838     fputs("\n*** r  = ", stderr); mp_writefile(r, stderr, 16);
 839     fputc('\n', stderr);
 840   }
 841   mp_drop(a);
 842   mp_drop(c);
 843   mp_drop(r);
 844   assert(mparena_count(MPARENA_GLOBAL) == 0);
 845   return (ok);
 846 }
 847
 848 static int tneg(dstr *v)
 849 {
 850   mp *a = *(mp **)v[0].buf;
 851   mp *r = *(mp **)v[1].buf;
 852   int ok = 1;
 853   mp *n = mp_neg(MP_NEW, a);
 854   if (!MP_EQ(r, n)) {
 855     ok = 0;
 856     fprintf(stderr, "\n*** neg failed\n");
 857     fputs("\n*** a  = ", stderr); mp_writefile(a, stderr, 10);
 858     fputs("\n*** r  = ", stderr); mp_writefile(r, stderr, 10);
 859     fputs("\n*** n  = ", stderr); mp_writefile(n, stderr, 10);
 860     fputc('\n', stderr);
 861   }
 862   mp_drop(n);
 863   n = mp_neg(a, a);
 864   if (!MP_EQ(r, n)) {
 865     ok = 0;
 866     fprintf(stderr, "\n*** neg failed\n");
 867     fputs("\n*** a* = ", stderr); mp_writefile(a, stderr, 10);
 868     fputs("\n*** r  = ", stderr); mp_writefile(r, stderr, 10);
 869     fputs("\n*** n  = ", stderr); mp_writefile(n, stderr, 10);
 870     fputc('\n', stderr);
 871   }
 872   mp_drop(a);
 873   mp_drop(r);
 874   assert(mparena_count(MPARENA_GLOBAL) == 0);
 875   return (ok);
 876 }
 877
 878 static int todd(dstr *v)
 879 {
 880   mp *a = *(mp **)v[0].buf;
 881   size_t rs = *(uint32 *)v[1].buf;
 882   mp *rt = *(mp **)v[2].buf;
 883   int ok = 1;
 884   mp *t;
 885   size_t s;
 886   t = mp_odd(MP_NEW, a, &s);
 887   if (s != rs || !MP_EQ(t, rt)) {
 888     ok = 0;
 889     fprintf(stderr, "\n*** odd failed");
 890     fputs("\n*** a  = ", stderr); mp_writefile(a, stderr, 10);
 891     fprintf(stderr, "\n*** s  = %lu", (unsigned long)s);
 892     fputs("\n*** t  = ", stderr); mp_writefile(t, stderr, 10);
 893     fprintf(stderr, "\n*** rs = %lu", (unsigned long)rs);
 894     fputs("\n*** rt = ", stderr); mp_writefile(rt, stderr, 10);
 895     fputc('\n', stderr);
 896   }
 897   mp_drop(a);
 898   mp_drop(rt);
 899   mp_drop(t);
 900   assert(mparena_count(MPARENA_GLOBAL) == 0);
 901   return (ok);
 902 }
 903
 904 static test_chunk tests[] = {
 905   { "lsl", tlsl, { &type_mp, &type_int, &type_mp, 0 } },
 906   { "lsr", tlsr, { &type_mp, &type_int, &type_mp, 0 } },
 907   { "lsl2c", tlsl2c, { &type_mp, &type_int, &type_mp, 0 } },
 908   { "lsr2c", tlsr2c, { &type_mp, &type_int, &type_mp, 0 } },
 909   { "setbit", tset, { &type_mp, &type_ulong, &type_mp, 0 } },
 910   { "clrbit", tclr, { &type_mp, &type_ulong, &type_mp, 0 } },
 911   { "add", tadd, { &type_mp, &type_mp, &type_mp, 0 } },
 912   { "sub", tsub, { &type_mp, &type_mp, &type_mp, 0 } },
 913   { "mul", tmul, { &type_mp, &type_mp, &type_mp, 0 } },
 914   { "div", tdiv, { &type_mp, &type_mp, &type_mp, &type_mp, 0 } },
 915   { "exp", texp, { &type_mp, &type_mp, &type_mp, 0 } },
 916   { "bin2c", tbin, { &type_string, &type_mp, &type_mp, &type_mp, 0 } },
 917   { "odd", todd, { &type_mp, &type_uint32, &type_mp, 0 } },
 918   { "neg", tneg, { &type_mp, &type_mp, 0 } },
 919   { 0, 0, { 0 } },
 920 };
 921
 922 int main(int argc, char *argv[])
 923 {
 924   sub_init();
 925   test_run(argc, argv, tests, SRCDIR "/tests/mp");
 926   return (0);
 927 }
 928
 929 #endif
 930
 931 /*----- That's all, folks -------------------------------------------------*/