Angle.hh

Go to the documentation of this file.

/*
 * Copyright (C) 2012-2014 Open Source Robotics Foundation
 *
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *     http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 *
*/

#ifndef _ANGLE_HH_
#define _ANGLE_HH_

#include <math.h>
#include <iostream>
#include "gazebo/util/system.hh"

#define GZ_RTOD(r) ((r) * 180 / M_PI)

#define GZ_DTOR(d) ((d) * M_PI / 180)

#define GZ_NORMALIZE(a) (atan2(sin(a), cos(a)))

namespace gazebo
{

  namespace math
  {

  class GAZEBO_VISIBLE Angle
  {
    public: static const Angle Zero;

    public: static const Angle Pi;

    public: static const Angle HalfPi;

    public: static const Angle TwoPi;

    public: Angle();

    public: Angle(double _radian);

    public: Angle(const Angle &_angle);

    public: virtual ~Angle();

    public: void SetFromRadian(double _radian);

    public: void SetFromDegree(double _degree);

    public: double Radian() const;

    public: double Degree() const;

    public: void Normalize();

    public: inline double operator*() const { return value; }
    public: Angle operator-(const Angle &_angle) const;

    public: Angle operator+(const Angle &_angle) const;

    public: Angle operator*(const Angle &_angle) const;

    public: Angle operator/(const Angle &_angle) const;

    public: Angle operator-=(const Angle &_angle);

    public: Angle operator+=(const Angle &_angle);

    public: Angle operator*=(const Angle &_angle);

    public: Angle operator/=(const Angle &_angle);

    public: bool operator ==(const Angle &_angle) const;

    public: bool operator!=(const Angle &_angle) const;

    public: bool operator<(const Angle &_angle) const;

    public: bool operator<=(const Angle &_angle) const;

    public: bool operator>(const Angle &_angle) const;

    public: bool operator>=(const Angle &_angle) const;

    public: friend std::ostream &operator<<(std::ostream &_out,
                                            const gazebo::math::Angle &_a)
    {
      _out << _a.Radian();
      return _out;
    }

    public: friend std::istream &operator>>(std::istream &_in,
                                            gazebo::math::Angle &_a)
    {
      // Skip white spaces
      _in.setf(std::ios_base::skipws);
      _in >> _a.value;
      return _in;
    }

    private: double value;
  };

  }
}

#endif