rom/mathieeesingbas/ieeespmul.c

   1 /*
   2     Copyright © 1995-2004, The AROS Development Team. All rights reserved.
   3     $Id$
   4 */
   5
   6 #include "mathieeesingbas_intern.h"
   7
   8 /*
   9     FUNCTION
  10         Multiply two IEEE single precision numbers
  11         res = y * z;
  12
  13     RESULT
  14
  15         Flags:
  16           zero     : result is zero
  17           negative : result is negative
  18           overflow : result is out of range
  19
  20     NOTES
  21
  22     EXAMPLE
  23
  24     BUGS
  25
  26     SEE ALSO
  27
  28     INTERNALS
  29
  30     HISTORY
  31 */
  32
  33 AROS_LH2(float, IEEESPMul,
  34     AROS_LHA(float, y, D0),
  35     AROS_LHA(float, z, D1),
  36     struct LibHeader *, MathIeeeSingBasBase, 13, Mathieeesingbas
  37 )
  38 {
  39     AROS_LIBFUNC_INIT
  40
  41     ULONG Mant1H = ((y & 0x00fff000) >> 12 ) | 0x00000800;
  42     ULONG Mant2H = ((z & 0x00fff000) >> 12 ) | 0x00000800;
  43     ULONG Mant1L = y & 0x00000fff;
  44     ULONG Mant2L = z & 0x00000fff;
  45     LONG Res;
  46     LONG Exponent = ((( y & IEEESPExponent_Mask))
  47                   + (( z & IEEESPExponent_Mask)) - 0x3f800000 );
  48
  49     if (0 == y || 0 == z)
  50     {
  51         SetSR(Zero_Bit, Zero_Bit | Negative_Bit | Overflow_Bit);
  52         return ((y & IEEESPSign_Mask) ^ (z & IEEESPSign_Mask) );
  53     }
  54
  55     Res  =  (Mant1H * Mant2H) <<  8;
  56     Res += ((Mant1H * Mant2L) >>  4);
  57     Res += ((Mant1L * Mant2H) >>  4);
  58     Res += ((Mant1L * Mant2L) >> 16);
  59
  60     /* Bit 32 is not set */
  61     if ((LONG)Res > 0) Res += Res;
  62     else               Exponent += 0x00800000;
  63
  64     /* Correction for precision */
  65     if ((char) Res < 0) Res += 0x100;
  66
  67     Res >>= 8;
  68     Res &= IEEESPMantisse_Mask;
  69
  70     Res |= ((y & IEEESPSign_Mask) ^ (z & IEEESPSign_Mask) );
  71
  72     if ( Exponent < 0)
  73     {
  74         SetSR(Overflow_Bit, Zero_Bit | Negative_Bit | Overflow_Bit);
  75         return (0x7f800000 | (Res & IEEESPSign_Mask) );
  76     }
  77
  78     Res |= Exponent;
  79
  80     if ( Res < 0) SetSR(Negative_Bit, Zero_Bit | Negative_Bit | Overflow_Bit);
  81
  82     return Res;
  83
  84     AROS_LIBFUNC_EXIT
  85 }