ETL/trunk/ETL/_angle.h

   1 #include <stdio.h>
   2 /* ========================================================================
   3 ** Extended Template and Library
   4 ** Angle Abstraction Class Implementation
   5 ** $Id$
   6 **
   7 ** Copyright (c) 2002 Robert B. Quattlebaum Jr.
   8 **
   9 ** This package is free software; you can redistribute it and/or
  10 ** modify it under the terms of the GNU General Public License as
  11 ** published by the Free Software Foundation; either version 2 of
  12 ** the License, or (at your option) any later version.
  13 **
  14 ** This package is distributed in the hope that it will be useful,
  15 ** but WITHOUT ANY WARRANTY; without even the implied warranty of
  16 ** MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  17 ** General Public License for more details.
  18 **
  19 ** === N O T E S ===========================================================
  20 **
  21 ** This is an internal header file, included by other ETL headers.
  22 ** You should not attempt to use it directly.
  23 **
  24 ** ========================================================================= */
  25
  26 /* === S T A R T =========================================================== */
  27
  28 #ifndef __ETL_ANGLE_H
  29 #define __ETL_ANGLE_H
  30
  31 /* === H E A D E R S ======================================================= */
  32
  33 #include <cmath>
  34 #include <functional>
  35
  36 /* === M A C R O S ========================================================= */
  37
  38 #ifndef PI
  39 # define PI (3.1415926535897932384626433832795029L)
  40 # define HALF_PI (PI/2)
  41 #endif
  42
  43 /* === T Y P E D E F S ===================================================== */
  44
  45 /* === C L A S S E S & S T R U C T S ======================================= */
  46
  47 _ETL_BEGIN_NAMESPACE
  48
  49 // ========================================================================
  50 /*!     \class  angle   _angle.h        ETL/angle
  51 **      \brief  Abstraction of the concept of an angle
  52 **  \see angle::deg, angle::rad, angle::rot, angle::sin, angle::cos, angle::tan, fastangle
  53 **      \writeme
  54 */
  55 class angle
  56 {
  57 public:
  58         typedef float value_type;
  59
  60 protected:
  61         typedef value_type unit;
  62
  63         unit v; //! Stored in radians; positive values indicate counter-clockwise.
  64
  65 public:
  66
  67         /*
  68         ** Arithmetic Operators
  69         */
  70
  71         const angle     &
  72         operator+=(const angle &rhs)
  73         { v+=rhs.v; return *this; }
  74
  75         const angle     &
  76         operator-=(const angle &rhs)
  77         { v-=rhs.v; return *this; }
  78
  79         const angle     &
  80         operator*=(const unit &rhs)
  81         { v*=rhs; return *this; }
  82
  83         const angle     &
  84         operator/=(const unit &rhs)
  85         { v/=rhs; return *this; }
  86
  87         //! Angle Addition Operator
  88         angle
  89         operator+(const angle &rhs)const
  90         { return angle(*this)+=rhs; }
  91
  92         //! Angle Subtraction Operator
  93         /*! \sa angle dist(const angle &) */
  94         angle
  95         operator-(const angle &rhs)const
  96         { return angle(*this)-=rhs; }
  97
  98         //! Angle Scalar Multiplication Operator
  99         /*! This operator will multiply the given
 100                 angle by the given scalar value. */
 101         angle
 102         operator*(const unit &rhs)const
 103         { return angle(*this)*=rhs; }
 104
 105         angle
 106         operator/(const unit &rhs)const
 107         { return angle(*this)/=rhs; }
 108
 109         //! Angle Negation
 110         angle
 111         operator-()const
 112         {
 113                 angle ret;
 114                 ret.v=-v;
 115                 return ret;
 116         }
 117
 118         //! 180 degree rotation operator
 119         /*! Returns the angle directly opposite of
 120                 the given angle, and will yield a result
 121                 between 0 and 2PI */
 122         angle
 123         operator~()const
 124         {
 125                 angle ret;
 126                 ret.v = v+PI;
 127                 return ret.mod();
 128         }
 129
 130         /*! Returns true if the shortest
 131                 angle from the left-hand to the
 132                 right-hand side is counter-clockwise */
 133         bool
 134         operator<(const angle &rhs)const
 135         { return dist(rhs).v<(value_type)0.0; }
 136
 137         /*! Returns true if the shortest
 138                 angle from the left-hand to the
 139                 right-hand side is clockwise */
 140         bool
 141         operator>(const angle &rhs)const
 142         { return dist(rhs).v>(value_type)0.0; }
 143
 144         /*! Returns true if the shortest
 145                 angle from the left-hand to the
 146                 right-hand side is counter-clockwise,
 147                 or if the angles are refer to the same
 148                 point on the unit circle. */
 149         bool
 150         operator<=(const angle &rhs)const
 151         { return dist(rhs).v<=(value_type)0.0; }
 152
 153         /*! Returns true if the shortest
 154                 angle from the left-hand to the
 155                 right-hand side is clockwise,
 156                 or if the angles are refer to the same
 157                 point on the unit circle. */
 158         bool
 159         operator>=(const angle &rhs)const
 160         { return dist(rhs).v>=(value_type)0.0; }
 161
 162         /*! Returns true if the angles
 163                 are refer to the same point
 164                 on the unit circle. */
 165         bool
 166         operator==(const angle &rhs)const
 167         { return std::abs(dist(rhs).v)<epsilon; }
 168
 169         /*! Returns false if the angles
 170                 are refer to the same point
 171                 on the unit circle. */
 172         bool
 173         operator!=(const angle &rhs)const
 174         { return std::abs(dist(rhs).v)>epsilon; }
 175
 176         //! Absolute Angle Function
 177         /*! This function will return the
 178                 absolute value of the angle. */
 179         angle
 180         abs()const
 181         {
 182                 angle ret;
 183                 ret.v=std::abs(v);
 184                 return ret;
 185         }
 186
 187         //! Angle Difference Function
 188         /*! This function will return the
 189                 shortest physical distance between
 190                 two angles, from -PI/2 to PI/2
 191                 \sa angle operator-(const angle &) */
 192         angle
 193         dist(const angle &rhs)const
 194         {
 195                 angle ret;
 196                 ret.v=v-rhs.v;
 197                 ret.v-=rot_floor(ret.v+PI);
 198                 return ret;
 199         }
 200
 201         //! Rotation Modulus
 202         /*! This function will return the
 203                 value of the angle between 0 and 2PI */
 204         angle
 205         mod()const
 206         {
 207                 angle ret(*this);
 208                 ret.v-=rot_floor(ret.v);
 209                 return ret;
 210         }
 211
 212         //! Zero Rotation (0 degrees)
 213         static angle
 214         zero()
 215         {
 216                 angle ret;
 217                 ret.v=0;
 218                 return ret;
 219         }
 220
 221         //! One Complete Rotation (360 degrees)
 222         static angle
 223         one()
 224         {
 225                 angle ret;
 226                 ret.v=PI*2;
 227                 return ret;
 228         }
 229
 230         //! One Half Rotation (180 degrees)
 231         static angle
 232         half()
 233         {
 234                 angle ret;
 235                 ret.v=PI;
 236                 return ret;
 237         }
 238
 239         bool operator!()const { return std::abs(mod().v) < epsilon; }
 240
 241 private:
 242
 243         static value_type rot_floor(value_type x)
 244         { return static_cast<value_type>(std::floor(x/(PI*2))*PI*2); }
 245
 246         static const value_type epsilon = 1.0e-6;
 247
 248 public:
 249         /*
 250         ** Conversion Classes
 251         */
 252
 253         class rad;
 254         class deg;
 255         class rot;
 256
 257         /*
 258         ** Trigonometric Classes
 259         */
 260
 261         class sin;
 262         class cos;
 263         class tan;
 264
 265         /*
 266         ** Friend classes
 267         */
 268
 269         friend class rad;
 270         friend class deg;
 271         friend class rot;
 272         friend class sin;
 273         friend class cos;
 274         friend class tan;
 275
 276         /*
 277         ** Deprecated
 278         */
 279
 280 #ifndef ETL_NO_DEPRECATED
 281         typedef rad             radians;
 282         typedef deg             degrees;
 283         typedef rot             rotations;
 284 #endif
 285 }; // END of class angle
 286
 287 // ========================================================================
 288 /*!     \class  angle::rad      _angle.h        ETL/angle
 289 **      \brief  Angle representation in radians
 290 **      \see angle
 291 **      \writeme
 292 */
 293 class angle::rad : public angle
 294 {
 295 public:
 296         explicit rad(const value_type &x) { v=x; }
 297         rad(const angle &a):angle(a) { }
 298         rad     mod()const { return angle::mod(); }
 299         rad dist(const angle &rhs)const { return angle::dist(rhs); }
 300         value_type get()const { return v; }
 301 #ifndef ETL_NO_DEPRECATED
 302         // operator value_type()const ETL_DEPRECATED_FUNCTION;
 303 #endif
 304 }; // END of class angle::radians
 305 // inline angle::rad::operator angle::value_type()const { return get(); }
 306
 307 // ========================================================================
 308 /*!     \class  angle::deg      _angle.h        ETL/angle
 309 **      \brief  Angle representation in degrees
 310 **      \see angle
 311 **      \writeme
 312 */
 313 class angle::deg : public angle
 314 {
 315 public:
 316         explicit deg(const value_type &x) { v=x*((PI*2)/360); }
 317         deg(const angle &a):angle(a) { }
 318         deg     mod()const { return angle::mod(); }
 319         deg dist(const angle &rhs)const { return angle::dist(rhs); }
 320         value_type get()const { return v*360/(PI*2); }
 321 #ifndef ETL_NO_DEPRECATED
 322         // operator value_type()const ETL_DEPRECATED_FUNCTION;
 323 #endif
 324 }; // END of class angle::degrees
 325 // inline angle::deg::operator angle::value_type()const { return get(); }
 326
 327 // ========================================================================
 328 /*!     \class  angle::rot      _angle.h        ETL/angle
 329 **      \brief  Angle representation in rotations
 330 **      \see angle
 331 **      \writeme
 332 */
 333 class angle::rot : public angle
 334 {
 335 public:
 336         explicit rot(const value_type &x) { v=x*(PI*2); }
 337         rot(const angle &a):angle(a) { }
 338         rot mod()const { return angle::mod(); }
 339         rot dist(const angle &rhs)const { return angle::dist(rhs); }
 340         value_type get()const { return v/(PI*2); }
 341 #ifndef ETL_NO_DEPRECATED
 342         // operator value_type()const ETL_DEPRECATED_FUNCTION;
 343 #endif
 344 }; // END of class angle::rotations
 345 // inline angle::rot::operator angle::value_type()const { return get(); }
 346
 347 // ========================================================================
 348 /*!     \class  angle::sin      _angle.h        ETL/angle
 349 **      \brief  Angle representation as a sine function
 350 **      \see angle
 351 **      \writeme
 352 */
 353 class angle::sin : public angle
 354 {
 355 public:
 356         explicit sin(const value_type &x) { v=static_cast<value_type>(std::asin(x)); }
 357         sin(const angle &a):angle(a) { }
 358         sin     mod()const { return angle::mod(); }
 359         sin dist(const angle &rhs)const { return angle::dist(rhs); }
 360         value_type get()const { return static_cast<value_type>(std::sin(v)); }
 361 #ifndef ETL_NO_DEPRECATED
 362         // operator value_type()const ETL_DEPRECATED_FUNCTION;
 363 #endif
 364 }; // END of class angle::sin
 365 // inline angle::sin::operator angle::value_type()const { return get(); }
 366
 367 // ========================================================================
 368 /*!     \class  angle::cos      _angle.h        ETL/angle
 369 **      \brief  Angle representation as a cosine function
 370 **      \see angle
 371 **      \writeme
 372 */
 373 class angle::cos : public angle
 374 {
 375 public:
 376         explicit cos(const value_type &x)       { v=(value_type)(std::acos(x)); }
 377         cos(const angle &a):angle(a) { }
 378         cos     mod()const { return angle::mod(); }
 379         cos dist(const angle &rhs)const { return angle::dist(rhs); }
 380         value_type get()const { return (value_type)std::cos(v); }
 381 #ifndef ETL_NO_DEPRECATED
 382         // operator value_type()const ETL_DEPRECATED_FUNCTION;
 383 #endif
 384 }; // END of class angle::cos
 385 // inline angle::cos::operator angle::value_type()const { return get(); }
 386
 387 // ========================================================================
 388 /*!     \class  angle::tan      _angle.h        ETL/angle
 389 **      \brief  Angle representation as a tangent function
 390 **      \see angle
 391 **      \writeme
 392 */
 393 class angle::tan : public angle
 394 {
 395 public:
 396         explicit tan(const value_type &x)       { v=(value_type)(std::atan(x)); }
 397         tan(const value_type &y,const value_type &x) { v=(value_type)(std::atan2(y,x)); }
 398         tan(const angle &a):angle(a) { }
 399         tan     mod()const { return angle::mod(); }
 400         tan dist(const angle &rhs)const { return angle::dist(rhs); }
 401         value_type get()const { return (value_type)std::tan(v); }
 402 #ifndef ETL_NO_DEPRECATED
 403         // operator value_type()const ETL_DEPRECATED_FUNCTION;
 404 #endif
 405 }; // END of class angle::tan
 406 // inline angle::tan::operator angle::value_type()const { return get(); }
 407
 408 _ETL_END_NAMESPACE
 409
 410 //#include <iostream>
 411
 412 template <typename T>
 413 struct affine_combo<etl::angle, T>
 414 {
 415         typedef T time_type;
 416
 417         //affine_combo() { std::cerr<<"affine_combo<etl::angle,float>: I was created!"<<std::endl; }
 418         //~affine_combo() { std::cerr<<"affine_combo<etl::angle,float>: I was DELETED!"<<std::endl; }
 419
 420         etl::angle operator()(const etl::angle &a,const etl::angle &b,const time_type &t)const
 421         {
 422                 return b.dist(a)*(float)t+a;
 423         }
 424
 425         etl::angle reverse(const etl::angle &x, const etl::angle &b, const time_type &t)const
 426         {
 427                 return x.dist(b*(float)t)*(float)(time_type(1)/(time_type(1)-t));
 428         }
 429 };
 430
 431 template <>
 432 struct distance_func<etl::angle> : public std::binary_function<etl::angle, etl::angle, etl::angle>
 433 {
 434         etl::angle operator()(const etl::angle &a,const etl::angle &b)const
 435         {
 436                 etl::angle delta=b.dist(a);
 437                 //if(delta<etl::angle::zero())
 438                 //      return delta+etl::angle::one();
 439                 return delta;
 440         }
 441
 442         etl::angle cook(const etl::angle &x)const { return x; }
 443         etl::angle uncook(const etl::angle &x)const { return x; }
 444 };
 445
 446 /* === E N D =============================================================== */
 447
 448 #endif