home *** CD-ROM | disk | FTP | other *** search
/ GEMini Atari / GEMini_Atari_CD-ROM_Walnut_Creek_December_1993.iso / files / gnu / g__lib / fix24.cc < prev    next >
Encoding:
C/C++ Source or Header  |  1993-07-23  |  8.2 KB  |  346 lines
  1. // This may look like C code, but it is really -*- C++ -*-
  2. /* 
  3. Copyright (C) 1988 Free Software Foundation
  4.     written by Kurt Baudendistel (gt-eedsp!baud@gatech.edu)
  5.     adapted for libg++ by Doug Lea (dl@rocky.oswego.edu)
  6.  
  7. This file is part of GNU CC.
  8.  
  9. GNU CC is distributed in the hope that it will be useful,
  10. but WITHOUT ANY WARRANTY.  No author or distributor
  11. accepts responsibility to anyone for the consequences of using it
  12. or for whether it serves any particular purpose or works at all,
  13. unless he says so in writing.  Refer to the GNU CC General Public
  14. License for full details.
  15.  
  16. Everyone is granted permission to copy, modify and redistribute
  17. GNU CC, but only under the conditions described in the
  18. GNU CC General Public License.   A copy of this license is
  19. supposed to have been given to you along with GNU CC so you
  20. can know your rights and responsibilities.  It should be in a
  21. file named COPYING.  Among other things, the copyright notice
  22. and this notice must be preserved on all copies.  
  23. */
  24.  
  25. //
  26. // Fix24.cc : fixed precision class support functions
  27. //
  28.  
  29. #include <Fix24.h>
  30.  
  31. const double
  32.   Fix24_fs = 2147483648.,
  33.   Fix24_mult = Fix24_fs,
  34.   Fix24_div = 1./Fix24_fs,
  35.   Fix24_max = 1. - .5/Fix24_fs,
  36.   Fix24_min = -1.;
  37.       
  38. const unsigned long
  39.   Fix24_msb = 0x80000000L,
  40.   Fix24_lsb = 0x00000100L,
  41.   Fix24_m_max = 0x7fffff00L,
  42.   Fix24_m_min = 0x80000000L;
  43.           
  44. const double
  45.   Fix48_fs = 4611686018427387904.,
  46.   Fix48_max = 1. - .5/Fix48_fs,
  47.   Fix48_min = -1.,
  48.   Fix48_div_u = 1./Fix24_fs,
  49.   Fix48_div_l = 1./Fix48_fs;
  50.    
  51. const twolongs
  52.   Fix48_msb = { 0x80000000L, 0L },
  53.   Fix48_lsb = { 0L, 0x00000100L },
  54.   Fix48_m_max = { 0x7fffff00L, 0xffffff00L },
  55.   Fix48_m_min = { 0x80000000L, 0L };
  56.           
  57. // basic operators too large to be inline
  58.  
  59. long Fix24::assign(double d) 
  60. { 
  61.   if (d == 1.0)
  62.     return Fix24_m_max;
  63.   else if (d > Fix24_max)
  64.   {
  65.     long i = Fix24_m_max;
  66.     range_error(i);
  67.     return i;
  68.   }
  69.   else if (d < Fix24_min)
  70.   {
  71.     long i = Fix24_m_min;
  72.     range_error(i);
  73.     return i;
  74.   }
  75.   else {
  76.     d *= Fix24_mult;
  77.     return (long)(d + ((d >= 0)? 0.5 : -0.5));
  78.   }
  79. }
  80.  
  81. twolongs Fix48::assign(double d) 
  82. { 
  83.   if (d == 1.0)
  84.     return Fix48_m_max;
  85.   else if (d > Fix48_max)
  86.   {
  87.     twolongs i = Fix48_m_max;
  88.     range_error(i);
  89.     return i;
  90.   }
  91.   else if (d < Fix48_min)
  92.   {
  93.     twolongs i = Fix48_m_min;
  94.     range_error(i);
  95.     return i;
  96.   }
  97.   else {
  98.     twolongs i;
  99.     i.u = (long)(d *= Fix24_mult);
  100.     i.l = (long)((d - (double)i.u) * Fix24_mult);
  101.     return i;
  102.   }
  103. }
  104.  
  105.  
  106. Fix48 operator * (Fix24& a, Fix24& b)
  107. {
  108. // break a and b into lo and hi parts, and do a multiple-precision
  109. // multiply, with rounding
  110.  
  111.   int apos = (a.m >= 0);
  112.   unsigned long ua = (apos)? a.m : - a.m;
  113.   ua <<= 1; // ua is biased so result will be 47 bit mantissa, not 46:
  114.   unsigned long hi_a = (ua >> 16) & ((1 << 16) - 1);
  115.   unsigned long lo_a = ua & ((1 << 16) - 1);
  116.  
  117.   int bpos = (b.m >= 0);
  118.   unsigned long ub = (bpos)? b.m : -b.m;
  119.   unsigned long hi_b = (ub >> 16) & ((1 << 16) - 1);
  120.   unsigned long lo_b = ub & ((1 << 16) - 1);
  121.  
  122.   unsigned long 
  123.     hi_r = hi_a * hi_b,
  124.     mi_r = hi_a * lo_b + lo_a * hi_b,
  125.     lo_r = lo_a * lo_b,
  126.     rl = ((hi_r << 16) & 0x00ffffffL) + (mi_r & 0x00ffffffL) + (lo_r >> 16);
  127.   twolongs r = {
  128.     (hi_r & 0xffffff00L) + ((mi_r >> 16) & 0x0000ff00L)
  129.       + ((rl >> 16) & 0x0000ff00L),
  130.     rl << 8
  131.   };
  132.  
  133.   if ( apos != bpos ) {
  134.     unsigned long l = r.l;
  135.     r.l = -r.l;
  136.     r.u = ~r.u + ((l ^ r.l) & Fix24_msb ? 0 : Fix24_lsb);
  137.   }
  138.   return r;
  139. }
  140.  
  141. Fix24 operator / (Fix24& a, Fix24& b)
  142. {
  143.   long q;
  144.   int apos = (a.m >= 0);
  145.   unsigned long la = (apos)? a.m : -a.m;
  146.   int bpos = (b.m >= 0);
  147.   unsigned long lb = (bpos)? b.m: -b.m;
  148.   if (la >= lb)
  149.   {
  150.     q = (apos == bpos)? Fix24_m_max: Fix24_m_min;
  151.     a.range_error(q);
  152.   }
  153.   else                        // standard shift-based division alg
  154.   {
  155.     q = 0;
  156.     long r = la;
  157.     for (int i = 31; i > 0; i--)
  158.     {
  159.       q <<= 1;
  160.       r <<= 1;
  161.       if (r >= 0)
  162.         r -= lb;
  163.       else
  164.         r += lb;
  165.       if (r >= 0)
  166.         q |= 1;
  167.     }
  168.     if (r < 0) r += lb;
  169.     if (r >= lb / 2) ++q;
  170.     if (apos != bpos) q = -q;
  171.   }
  172.   return q;
  173. }
  174.  
  175. Fix48 operator + (Fix48&  f, Fix48&  g)
  176. {
  177.   long lo_r = (f.m.l >> 8) + (g.m.l >> 8);
  178.   twolongs r = {
  179.     f.m.u + g.m.u + (lo_r & 0x01000000L ? 0x00000100L : 0),
  180.     lo_r << 8
  181.   };
  182.   if ( (f.m.u ^ r.u) & (g.m.u ^ r.u) & Fix24_msb )
  183.     f.overflow(r);
  184.   return r;
  185. }
  186.  
  187. Fix48 operator - (Fix48&  f, Fix48&  g)
  188. {
  189.   long lo_r = (f.m.l >> 8) - (g.m.l >> 8);
  190.   twolongs r = {
  191.     f.m.u - g.m.u - (lo_r & 0x01000000L ? 0x00000100L: 0),
  192.     lo_r << 8
  193.   };
  194.   if ( (f.m.u ^ r.u) & (-g.m.u ^ r.u) & Fix24_msb )
  195.     f.overflow(r);
  196.   return r;
  197. }
  198.  
  199. Fix48 operator * (Fix48& a, int b)
  200. {
  201.   twolongs r;
  202.   int bpos = (b >= 0);
  203.   unsigned ub = (bpos)? b : -b;
  204.   if ( ub >= 65536L ) {
  205.     r = (bpos)? Fix48_m_max : Fix48_m_min;
  206.     a.range_error(r);
  207.   }
  208.   else {
  209.     unsigned long 
  210.       lo_r = (a.m.l & 0xffff) * ub,
  211.       mi_r = ((a.m.l >> 16) & 0xffff) * ub,
  212.       hi_r = a.m.u * ub;
  213.     r.l = lo_r + (mi_r << 16);
  214.     r.u = hi_r + ((mi_r >> 8) & 0x00ffff00L);
  215.     if ( !bpos ) {
  216.       unsigned long l = r.l;
  217.       r.l = -r.l;
  218.       r.u = ~r.u + ((l ^ r.l) & Fix24_msb ? 0 : Fix24_lsb);
  219.     }
  220.   }
  221.   return r;
  222. }
  223.  
  224. Fix48 operator << (Fix48& a, int b)
  225. {
  226.   twolongs r = { 0L, 0L };
  227.   if ( b >= 0 )
  228.     if ( b < 24 ) {
  229.       r.u = (a.m.u << b) + ((a.m.l >> (24 - b)) & 0xffffff00L);
  230.       r.l = a.m.l << b;
  231.     }
  232.     else if ( b < 48 ) {
  233.       r.u = a.m.l << (b - 24);
  234.     }
  235.   return r;
  236. }
  237.  
  238. Fix48 operator >> (Fix48& a, int b)
  239. {
  240.   twolongs r = { 0L, 0L };
  241.   if ( b >= 0 )
  242.     if ( b < 24 ) {
  243.       r.l = (a.m.u << (24 - b)) + ((a.m.l >> b) & 0xffffff00L);
  244.       r.u = (a.m.u >> b) & 0xffffff00L;
  245.     }
  246.     else if ( b < 48 ) {
  247.       r.l = (a.m.u >> (b - 24)) & 0xffffff00L;
  248.       r.u = (a.m.u >> 24) & 0xffffff00L;
  249.     }
  250.     else {
  251.       r.l = (a.m.u >> 24) & 0xffffff00L;
  252.       r.u = r.l;
  253.     }
  254.   return r;
  255. }
  256.  
  257. // error handling
  258.  
  259. void Fix24::overflow(long& i)
  260. {
  261.   (*Fix24_overflow_handler)(i);
  262. }
  263.  
  264. void Fix48::overflow(twolongs& i)
  265. {
  266.   (*Fix48_overflow_handler)(i);
  267. }
  268.  
  269. void Fix24::range_error(long& i)
  270. {
  271.   (*Fix24_range_error_handler)(i);
  272. }
  273.  
  274. void Fix48::range_error(twolongs& i)
  275. {
  276.   (*Fix48_range_error_handler)(i);
  277. }
  278.  
  279. // data definitions
  280.  
  281. Fix24_peh Fix24_overflow_handler = Fix24_overflow_saturate;
  282. Fix48_peh Fix48_overflow_handler = Fix48_overflow_saturate;
  283.  
  284. Fix24_peh Fix24_range_error_handler = Fix24_warning;
  285. Fix48_peh Fix48_range_error_handler = Fix48_warning;
  286.  
  287. //function definitions
  288.  
  289. Fix24_peh set_Fix24_overflow_handler(Fix24_peh new_handler) {
  290.   Fix24_peh old_handler = Fix24_overflow_handler;
  291.   Fix24_overflow_handler = new_handler;
  292.   return old_handler;
  293. }
  294.  
  295. Fix48_peh set_Fix48_overflow_handler(Fix48_peh new_handler) {
  296.   Fix48_peh old_handler = Fix48_overflow_handler;
  297.   Fix48_overflow_handler = new_handler;
  298.   return old_handler;
  299. }
  300.  
  301. void set_overflow_handler(Fix24_peh handler24, Fix48_peh handler48) {
  302.   set_Fix24_overflow_handler(handler24);
  303.   set_Fix48_overflow_handler(handler48);
  304. }
  305.  
  306. Fix24_peh set_Fix24_range_error_handler(Fix24_peh new_handler) {
  307.   Fix24_peh old_handler = Fix24_range_error_handler;
  308.   Fix24_range_error_handler = new_handler;
  309.   return old_handler;
  310. }
  311.  
  312. Fix48_peh set_Fix48_range_error_handler(Fix48_peh new_handler) {
  313.   Fix48_peh old_handler = Fix48_range_error_handler;
  314.   Fix48_range_error_handler = new_handler;
  315.   return old_handler;
  316. }
  317.  
  318. void set_range_error_handler(Fix24_peh handler24, Fix48_peh handler48) {
  319.   set_Fix24_range_error_handler(handler24);
  320.   set_Fix48_range_error_handler(handler48);
  321. }
  322.  
  323. void Fix24_overflow_saturate(long& i)
  324.   { i = (i > 0 ? Fix24_m_min : Fix24_m_max); }
  325. void Fix24_ignore(long&) {}
  326. void Fix24_warning(long&)
  327.   { cerr << "warning: Fix24 result out of range\n"; }
  328. void Fix24_overflow_warning_saturate(long& i)
  329.   { cerr << "warning: Fix24 result out of range\n"; 
  330.    Fix24_overflow_saturate(i); }
  331. void Fix24_abort(long&)
  332.   { cerr << "error: Fix24 result out of range\n"; abort(); }
  333.  
  334. void Fix48_ignore(twolongs&) {}
  335. void Fix48_overflow_saturate(twolongs& i)
  336.   { i = (i.u > 0 ? Fix48_m_min : Fix48_m_max); }
  337. void Fix48_warning(twolongs&)
  338.   { cerr << "warning: Fix48 result out of range\n"; }
  339. void Fix48_overflow_warning_saturate(twolongs& i)
  340.   { cerr << "warning: Fix48 result out of range\n"; 
  341.    Fix48_overflow_saturate(i); }
  342. void Fix48_abort(twolongs&)
  343.   { cerr << "error: Fix48 result out of range\n"; abort(); }
  344.  
  345.  
  346.