Point6D.h

Go to the documentation of this file.

#ifndef POINT6D_H_
#define POINT6D_H_

#include "data/I1D.h"
#include "utils/Str.h"

class Point3D;
class Matrix6x6;

class Point6D: public I1D<double>
{
public:
    inline void setX( const double x )
    {
        value_[0] = x;
    }
    inline double getX() const
    {
        return value_[0];
    }

    inline void setY( const double y )
    {
        value_[1] = y;
    }
    inline double getY() const
    {
        return value_[1];
    }

    inline void setZ( const double z )
    {
        value_[2] = z;
    }
    inline double getZ() const
    {
        return value_[2];
    }

    inline void setRoll( const double roll )
    {
        value_[3] = roll;
    }
    inline double getRoll() const
    {
        return value_[3];
    }

    inline void setPitch( const double pitch )
    {
        value_[4] = pitch;
    }
    inline double getPitch() const
    {
        return value_[4];
    }

    inline void setHeading( const double heading )
    {
        value_[5] = heading;
    }
    inline double getHeading() const
    {
        return value_[5];
    }

    inline void setU( const double u )
    {
        value_[0] = u;
    }
    inline double getU() const
    {
        return value_[0];
    }

    inline void setV( const double v )
    {
        value_[1] = v;
    }
    inline double getV() const
    {
        return value_[1];
    }

    inline void setW( const double w )
    {
        value_[2] = w;
    }
    inline double getW() const
    {
        return value_[2];
    }

    inline void setP( const double p )
    {
        value_[3] = p;
    }
    inline double getP() const
    {
        return value_[3];
    }

    inline void setQ( const double q )
    {
        value_[4] = q;
    }
    inline double getQ() const
    {
        return value_[4];
    }

    inline void setR( const double r )
    {
        value_[5] = r;
    }
    inline double getR() const
    {
        return value_[5];
    }

    Point6D( );

    Point6D( const double& init );

    Point6D( const double& x, const double& y, const double& z,
             const double& roll, const double& pitch, const double& heading );

    Point6D( const Point6D& value );
    /*
        Point6D( const void *binary );
    */
    virtual ~Point6D()
    {}
    ;

    Point6D* copy() const;

    // as a Str
    virtual Str toString() const;

    Point6D& operator=( const Point6D& rhs );

    Point6D& operator=( const double rhs );

    Point6D& operator+=( const Point6D& rhs );

    Point6D& operator+=( const Point3D& rhs );

    Point6D& operator+=( const double rhs );

    Point6D& operator-=( const Point6D& rhs );

    Point6D& operator-=( const double rhs );

    Point6D& operator*=( const Point6D& rhs );

    Point6D& operator*=( const double rhs );

    Point6D& addProduct( Matrix6x6& lhs, Point6D& rhs );

    Point6D& addProduct( const Point6D& lhs, const double rhs );

    Point6D& addProduct( const Point3D& lhs, const double rhs );

    Point6D& toAbs();

    double& operator[]( int index );

    const double absSum() const;

    const double sum() const;

    const double sumSquared() const;

    virtual double* getPtr1d()
    {
        return value_;
    }

    virtual int getM() const
    {
        return 6;
    }

protected:

    // The actual data
    double value_[6];

};

#endif /*POINT6D_H_*/