home *** CD-ROM | disk | FTP | other *** search
/ GEMini Atari / GEMini_Atari_CD-ROM_Walnut_Creek_December_1993.iso / files / gnu / g__lib / fix16.h < prev    next >
C/C++ Source or Header  |  1993-07-23  |  13KB  |  630 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. #ifndef _Fix16_h
  26. #pragma once
  27. #define _Fix16_h 1
  28.  
  29. #include <stream.h>
  30. #include <std.h>
  31.  
  32. // constant definitions
  33.  
  34. #define Fix16_fs     ((double)((unsigned)(1 << 15)))
  35.  
  36. #define Fix16_msb    (1 << 15)
  37. #define Fix16_m_max    ((1 << 15) - 1)
  38. #define Fix16_m_min    ((short)(1 << 15))
  39.  
  40. #define Fix16_mult    Fix16_fs
  41. #define Fix16_div    (1./Fix16_fs)
  42. #define Fix16_max    (1. - .5/Fix16_fs)
  43. #define Fix16_min    (-1.)
  44.  
  45.  
  46. #define Fix32_fs     ((double)((unsigned long)(1 << 31)))
  47.  
  48. #define Fix32_msb    ((unsigned long)(1 << 31))
  49. #define Fix32_m_max    ((1 << 31) - 1)
  50. #define Fix32_m_min    ((long)(1 << 31))
  51.  
  52. #define Fix32_mult    Fix32_fs
  53. #define Fix32_div    (1./Fix32_fs)
  54. #define Fix32_max    (1. - .5/Fix32_fs)
  55. #define Fix32_min    (-1.)
  56.  
  57.  
  58. //
  59. // Fix16    class: 16-bit Fixed point data type
  60. //
  61. //    consists of a 16-bit mantissa (sign bit & 15 data bits).
  62. //
  63.  
  64. class Fix16 
  65. { 
  66.   friend class          Fix32;
  67.  
  68.   short                 m;
  69.  
  70.   short                 round(double d);
  71.   short                 assign(double d);
  72.                         Fix16(short i);
  73.                         Fix16(int i);
  74.  
  75.   double operator       double();
  76.  
  77.  
  78. public:
  79.                         Fix16();
  80.                         Fix16(Fix16&  f);
  81.                         Fix16(double d);
  82.                         Fix16(Fix32& f);
  83.  
  84.                         ~Fix16();
  85.  
  86.   Fix16&                operator=(Fix16&  f);
  87.   Fix16&                operator=(double d);
  88.   Fix16&                operator=(Fix32& f);
  89.  
  90.   friend short&         mantissa(Fix16&  f);
  91.   friend double         value(Fix16&  f);
  92.  
  93.   Fix16                 operator +  ();
  94.   Fix16                 operator -  ();
  95.  
  96.   friend Fix16          operator +  (Fix16&  f, Fix16&  g);
  97.   friend Fix16          operator -  (Fix16&  f, Fix16&  g);
  98.   friend Fix32          operator *  (Fix16&  f, Fix16&  g);
  99.   friend Fix16          operator /  (Fix16&  f, Fix16&  g);
  100.   friend Fix16          operator << (Fix16&  f, int b);
  101.   friend Fix16          operator >> (Fix16&  f, int b);
  102.  
  103.   Fix16&                operator += (Fix16&  f);
  104.   Fix16&                operator -= (Fix16&  f);
  105.   Fix16&                operator *= (Fix16& );
  106.   Fix16&                operator /= (Fix16&  f);
  107.   
  108.   Fix16&                operator <<=(int b);
  109.   Fix16&                operator >>=(int b);
  110.  
  111.   friend int            operator == (Fix16&  f, Fix16&  g);
  112.   friend int            operator != (Fix16&  f, Fix16&  g);
  113.   friend int            operator >= (Fix16&  f, Fix16&  g);
  114.   friend int            operator <= (Fix16&  f, Fix16&  g);
  115.   friend int            operator >  (Fix16&  f, Fix16&  g);
  116.   friend int            operator <  (Fix16&  f, Fix16&  g);
  117.  
  118.   friend istream&       operator >> (istream& s, Fix16&  f);
  119.   friend ostream&       operator << (ostream& s, Fix16&  f);
  120.  
  121.   void                  overflow(short&);
  122.   void                  range_error(short&);
  123.  
  124.   friend Fix16          operator *  (Fix16&  f, int g);
  125.   friend Fix16          operator *  (int g, Fix16&  f);
  126.   Fix16&                operator *= (int g);
  127. };
  128.  
  129.  
  130. //
  131. // Fix32 class: 32-bit Fixed point data type
  132. //
  133. //    consists of a 32-bit mantissa (sign bit & 31 data bits).
  134. //
  135.  
  136. class Fix32 
  137. { 
  138.   friend class         Fix16;
  139.  
  140.   long                 m;
  141.  
  142.   long                 round(double d);
  143.   long                 assign(double d);
  144.  
  145.                        Fix32(long i);
  146.   double               operator double();
  147.  
  148.  
  149. public:
  150.                        Fix32();
  151.                        Fix32(Fix32& f);
  152.                        Fix32(Fix16&  f);
  153.                        Fix32(double d);
  154.                        ~Fix32();
  155.  
  156.   Fix32&               operator =  (Fix32& f);
  157.   Fix32&               operator =  (Fix16&  f);
  158.   Fix32&               operator =  (double d);
  159.  
  160.   friend long&         mantissa(Fix32& f);
  161.   friend double        value(Fix32& f);
  162.  
  163.   Fix32                operator +  ();
  164.   Fix32                operator -  ();
  165.  
  166.   friend Fix32         operator +  (Fix32& f, Fix32& g);
  167.   friend Fix32         operator -  (Fix32& f, Fix32& g);
  168.   friend Fix32         operator *  (Fix32& f, Fix32& g);
  169.   friend Fix32         operator /  (Fix32& f, Fix32& g);
  170.   friend Fix32         operator << (Fix32& f, int b);
  171.   friend Fix32         operator >> (Fix32& f, int b);
  172.  
  173.   Fix32&               operator += (Fix32& f);
  174.   Fix32&               operator -= (Fix32& f);
  175.   Fix32&               operator *= (Fix32& f);
  176.   Fix32&               operator /= (Fix32& f);
  177.   Fix32&               operator <<=(int b);
  178.   Fix32&               operator >>=(int b);
  179.  
  180.   friend int           operator == (Fix32& f, Fix32& g);
  181.   friend int           operator != (Fix32& f, Fix32& g);
  182.   friend int           operator >= (Fix32& f, Fix32& g);
  183.   friend int           operator <= (Fix32& f, Fix32& g);
  184.   friend int           operator >  (Fix32& f, Fix32& g);
  185.   friend int           operator <  (Fix32& f, Fix32& g);
  186.  
  187.   friend istream&      operator >> (istream& s, Fix32& f);
  188.   friend ostream&      operator << (ostream& s, Fix32& f);
  189.  
  190.   void                 overflow(long& i);
  191.   void                 range_error(long& i);
  192.  
  193.   friend Fix32          operator *  (Fix32&  f, int g);
  194.   friend Fix32          operator *  (int g, Fix32&  f);
  195.   Fix32&                operator *= (int g);
  196. };
  197.  
  198. inline Fix16::~Fix16() {}
  199.  
  200. inline short Fix16::round(double d)
  201. { 
  202.   return short( (d >= 0)? d + 0.5 : d - 0.5); 
  203. }
  204.  
  205. inline Fix16::Fix16(short i)        
  206. { 
  207.   m = i; 
  208. }
  209.  
  210. inline Fix16::Fix16(int i)        
  211. { 
  212.   m = i; 
  213. }
  214.  
  215. inline double Fix16::operator double() 
  216. { 
  217.   return  Fix16_div * m; 
  218. }
  219.  
  220. inline Fix16::Fix16()                 
  221. { 
  222.   m = 0; 
  223. }
  224.  
  225. inline Fix16::Fix16(Fix16&  f)        
  226. { 
  227.   m = f.m; 
  228. }
  229.  
  230. inline Fix16::Fix16(double d)        
  231. {
  232.   m = assign(d);
  233. }
  234.  
  235. inline Fix16::Fix16(Fix32& f)        
  236. { 
  237.   m = f.m >> 16; 
  238. }
  239.  
  240. inline Fix16&  Fix16::operator=(Fix16&  f)    
  241. { 
  242.   m = f.m; 
  243.   return *this; 
  244. }
  245.  
  246. inline Fix16&  Fix16::operator=(double d) 
  247. { 
  248.   m = assign(d); 
  249.   return *this; 
  250. }
  251.  
  252. inline Fix16&  Fix16::operator=(Fix32& f)
  253. { 
  254.   m = f.m >> 16; 
  255.   return *this; 
  256. }
  257.  
  258. inline short& mantissa(Fix16&  f)    
  259. { 
  260.   return f.m; 
  261. }
  262.  
  263. inline double value(Fix16&  f)        
  264. { 
  265.   return double(f); 
  266. }
  267.  
  268. inline Fix16 Fix16::operator+()         
  269. { 
  270.   return m; 
  271. }
  272.  
  273. inline Fix16 Fix16::operator-()         
  274. { 
  275.   return -m; 
  276. }
  277.  
  278. inline Fix16 operator+(Fix16&  f, Fix16&  g) 
  279. {
  280.   short sum = f.m + g.m;
  281.   if ( (f.m ^ sum) & (g.m ^ sum) & Fix16_msb )
  282.     f.overflow(sum);
  283.   return sum;
  284. }
  285.  
  286. inline Fix16 operator-(Fix16&  f, Fix16&  g) 
  287. {
  288.   short sum = f.m - g.m;
  289.   if ( (f.m ^ sum) & (-g.m ^ sum) & Fix16_msb )
  290.     f.overflow(sum);
  291.   return sum;
  292. }
  293.  
  294. inline Fix32 operator*(Fix16&  f, Fix16&  g)
  295. { 
  296.   return Fix32( long( long(f.m) * long(g.m) << 1)); 
  297. }
  298.  
  299. inline Fix16 operator<<(Fix16& a, int b)     
  300. { 
  301.   return a.m << b; 
  302. }
  303.  
  304. inline Fix16 operator>>(Fix16& a, int b)     
  305. { 
  306.   return a.m >> b; 
  307. }
  308.  
  309. inline  Fix16&  Fix16:: operator+=(Fix16&  f)
  310. { 
  311.   return *this = *this + f; 
  312. }
  313.  
  314. inline Fix16&  Fix16:: operator-=(Fix16&  f)     
  315. { 
  316.   return *this = *this - f; 
  317. }
  318.  
  319. inline Fix16& Fix16::operator*=(Fix16& f)     
  320. { 
  321.   return *this = *this * f; 
  322. }
  323.  
  324. inline Fix16&  Fix16:: operator/=(Fix16&  f)     
  325. { 
  326.   return *this = *this / f; 
  327. }
  328.  
  329. inline Fix16&  Fix16:: operator<<=(int b)    
  330. { 
  331.   return *this = *this << b;
  332. }
  333.  
  334. inline Fix16&  Fix16:: operator>>=(int b)    
  335. { 
  336.   return *this = *this >> b;
  337. }
  338.  
  339. inline int operator==(Fix16&  f, Fix16&  g)    
  340. { 
  341.   return f.m == g.m;
  342. }
  343.  
  344. inline int operator!=(Fix16&  f, Fix16&  g)    
  345. { 
  346.   return f.m != g.m;
  347. }
  348.  
  349. inline int operator>=(Fix16&  f, Fix16&  g)    
  350. { 
  351.   return f.m >= g.m;
  352. }
  353.  
  354. inline int operator<=(Fix16&  f, Fix16&  g)    
  355. { 
  356.   return f.m <= g.m;
  357. }
  358.  
  359. inline int operator>(Fix16&  f, Fix16&  g)    
  360. { 
  361.   return f.m > g.m;
  362. }
  363.  
  364. inline int operator<(Fix16&  f, Fix16&  g)    
  365. { 
  366.   return f.m < g.m;
  367. }
  368.  
  369. inline istream&  operator>>(istream& s, Fix16&  f)
  370. { 
  371.   double d;
  372.   s >> d; 
  373.   f = d; 
  374.   return s; 
  375. }
  376.  
  377. inline ostream&  operator<<(ostream& s, Fix16&  f)
  378. { 
  379.   return s << double(f);
  380. }
  381.  
  382. inline Fix16 operator*(int g, Fix16&  f)
  383. {
  384.   return f * g;
  385. }
  386.  
  387. inline Fix16& Fix16::operator*=(int g)
  388. {
  389.   return *this = *this * g;
  390. }
  391.  
  392. inline Fix16 operator*(Fix16&  f, int g)
  393. {
  394.   return Fix16(short(f.m * g));
  395. }
  396.  
  397. inline Fix32::~Fix32() {}
  398.  
  399. inline long Fix32::round(double d)
  400. { 
  401.   return long( (d >= 0)? d + 0.5 : d - 0.5);
  402. }
  403.  
  404. inline Fix32::Fix32(long i)        
  405. { 
  406.   m = i;
  407. }
  408.  
  409. inline double Fix32:: operator double()        
  410. { 
  411.   return Fix32_div * m;
  412. }
  413.  
  414. inline Fix32::Fix32()                
  415. { 
  416.   m = 0;
  417. }
  418.  
  419. inline Fix32::Fix32(Fix32& f)        
  420. { 
  421.   m = f.m;
  422. }
  423.  
  424. inline Fix32::Fix32(Fix16&  f)    
  425. { 
  426.   m = long(f.m) << 16;
  427. }
  428.  
  429. inline Fix32::Fix32(double d)        
  430. { 
  431.   m = assign(d);
  432. }
  433.  
  434. inline Fix32& Fix32::operator=(Fix32& f)    
  435. { 
  436.   m = f.m;
  437.   return *this; 
  438. }
  439.  
  440. inline Fix32& Fix32::operator=(Fix16&  f)    
  441. { 
  442.   m = long(f.m) << 16;
  443.   return *this;
  444. }
  445.  
  446. inline Fix32& Fix32::operator=(double d)    
  447. { 
  448.   m = assign(d);
  449.   return *this; 
  450. }
  451.  
  452. inline long& mantissa(Fix32& f)    
  453. { 
  454.   return f.m;
  455. }
  456.  
  457. inline double value(Fix32& f)        
  458. { 
  459.   return double(f);
  460. }
  461.  
  462. inline Fix32 Fix32::operator+()         
  463. { 
  464.   return m;
  465. }
  466.  
  467. inline Fix32 Fix32::operator-()         
  468. { 
  469.   return -m;
  470. }
  471.  
  472. inline Fix32 operator+(Fix32& f, Fix32& g) 
  473. {
  474.   long sum = f.m + g.m;
  475.   if ( (f.m ^ sum) & (g.m ^ sum) & Fix32_msb )
  476.     f.overflow(sum);
  477.   return sum;
  478. }
  479.  
  480. inline Fix32 operator-(Fix32& f, Fix32& g) 
  481. {
  482.   long sum = f.m - g.m;
  483.   if ( (f.m ^ sum) & (-g.m ^ sum) & Fix32_msb )
  484.     f.overflow(sum);
  485.   return sum;
  486. }
  487.  
  488. inline Fix32 operator<<(Fix32& a, int b)     
  489. { 
  490.   return a.m << b;
  491. }
  492.  
  493. inline Fix32 operator>>(Fix32& a, int b)     
  494. { 
  495.   return a.m >> b;
  496. }
  497.  
  498. inline Fix32& Fix32::operator+=(Fix32& f)     
  499. { 
  500.   return *this = *this + f;
  501. }
  502.  
  503. inline Fix32& Fix32::operator-=(Fix32& f)     
  504. { 
  505.   return *this = *this - f;
  506. }
  507.  
  508. inline Fix32& Fix32::operator*=(Fix32& f)     
  509. { 
  510.   return *this = *this * f;
  511. }
  512.  
  513. inline Fix32& Fix32::operator/=(Fix32& f)     
  514. { 
  515.   return *this = *this / f;
  516. }
  517.  
  518.  
  519. inline Fix32& Fix32::operator<<=(int b)    
  520. { 
  521.   return *this = *this << b;
  522. }
  523.  
  524. inline Fix32& Fix32::operator>>=(int b)    
  525. { 
  526.   return *this = *this >> b;
  527. }
  528.  
  529. inline int operator==(Fix32& f, Fix32& g)    
  530. { 
  531.   return f.m == g.m;
  532. }
  533.  
  534. inline int operator!=(Fix32& f, Fix32& g)    
  535. { 
  536.   return f.m != g.m;
  537. }
  538.  
  539. inline int operator>=(Fix32& f, Fix32& g)    
  540. { 
  541.   return f.m >= g.m;
  542. }
  543.  
  544. inline int operator<=(Fix32& f, Fix32& g)    
  545. { 
  546.   return f.m <= g.m;
  547. }
  548.  
  549. inline int operator>(Fix32& f, Fix32& g)    
  550. { 
  551.   return f.m > g.m;
  552. }
  553.  
  554. inline int operator<(Fix32& f, Fix32& g)    
  555. { 
  556.   return f.m < g.m;
  557. }
  558.  
  559. inline istream& operator>>(istream& s, Fix32& f)
  560. { 
  561.   double d;
  562.   s >> d; 
  563.   f = d; 
  564.   return s; 
  565. }
  566.  
  567. inline ostream& operator<<(ostream& s, Fix32& f)
  568. { 
  569.   return s << double(f);
  570. }
  571.  
  572. inline Fix32 operator*(int g, Fix32&  f)
  573. {
  574.   return f * g;
  575. }
  576.  
  577. inline Fix32& Fix32::operator*=(int g)
  578. {
  579.   return *this = *this * g;
  580. }
  581.  
  582. inline Fix32 operator*(Fix32&  f, int g)
  583. {
  584.   return Fix32(long(f.m * g));
  585. }
  586.  
  587.  
  588. // active error handler declarations
  589.  
  590. typedef void (*Fix16_peh)(short&);
  591. typedef void (*Fix32_peh)(long&);
  592.  
  593. extern Fix16_peh Fix16_overflow_handler;
  594. extern Fix32_peh Fix32_overflow_handler;
  595.  
  596. extern Fix16_peh Fix16_range_error_handler;
  597. extern Fix32_peh Fix32_range_error_handler;
  598.  
  599.  
  600. // error handler declarations
  601.  
  602. overload set_overflow_handler;
  603. extern Fix16_peh set_Fix16_overflow_handler(Fix16_peh);
  604. extern Fix32_peh set_Fix32_overflow_handler(Fix32_peh);
  605. extern void set_overflow_handler(Fix16_peh, Fix32_peh);
  606.  
  607. overload set_range_error_handler;
  608.  
  609. extern Fix16_peh set_Fix16_range_error_handler(Fix16_peh);
  610. extern Fix32_peh set_Fix32_range_error_handler(Fix32_peh);
  611. extern void set_range_error_handler(Fix16_peh, Fix32_peh);
  612.  
  613. extern void
  614.   Fix16_ignore(short&),
  615.   Fix16_overflow_saturate(short&),
  616.   Fix16_overflow_warning_saturate(short&),
  617.   Fix16_warning(short&),
  618.   Fix16_abort(short&);
  619.  
  620. extern void
  621.   Fix32_ignore(long&),
  622.   Fix32_overflow_saturate(long&),
  623.   Fix32_overflow_warning_saturate(long&),
  624.   Fix32_warning(long&),
  625.   Fix32_abort(long&);
  626.  
  627.  
  628. #endif
  629.  
  630.