Position2D.h

Go to the documentation of this file.

/****************************************************************************/
// A position in a 2D-world
/****************************************************************************/
// SUMO, Simulation of Urban MObility; see http://sumo.sourceforge.net/
// Copyright 2001-2010 DLR (http://www.dlr.de/) and contributors
/****************************************************************************/
//
//   This program is free software; you can redistribute it and/or modify
//   it under the terms of the GNU General Public License as published by
//   the Free Software Foundation; either version 2 of the License, or
//   (at your option) any later version.
//
/****************************************************************************/
#ifndef Position2D_h
#define Position2D_h


// ===========================================================================
// included modules
// ===========================================================================
#include <iostream>
#include <cmath>

#ifdef _MSC_VER
#include <windows_config.h>
#else
#include <config.h>
#endif

// ===========================================================================
// class definitions
// ===========================================================================
class Position2D {
public:
    Position2D() : myX(0.0), myY(0.0) { }

    Position2D(SUMOReal x, SUMOReal y)
            : myX(x), myY(y) { }

    ~Position2D() { }

    SUMOReal x() const {
        return myX;
    }

    SUMOReal y() const {
        return myY;
    }

    void set(SUMOReal x, SUMOReal y) {
        myX = x;
        myY = y;
    }

    void set(const Position2D &pos) {
        myX = pos.myX;
        myY = pos.myY;
    }


    void mul(SUMOReal val) {
        myX *= val;
        myY *= val;
    }

    void mul(SUMOReal mx, SUMOReal my) {
        myX *= mx;
        myY *= my;
    }

    void add(const Position2D &pos) {
        myX += pos.myX;
        myY += pos.myY;
    }

    void add(SUMOReal dx, SUMOReal dy) {
        myX += dx;
        myY += dy;
    }

    void sub(SUMOReal dx, SUMOReal dy) {
        myX -= dx;
        myY -= dy;
    }

    void sub(const Position2D &pos) {
        myX -= pos.myX;
        myY -= pos.myY;
    }

    void norm() {
        SUMOReal val = sqrt(myX*myX + myY*myY);
        myX = myX / val;
        myY = myY / val;
    }

    void reshiftRotate(SUMOReal xoff, SUMOReal yoff, SUMOReal rot) {
        SUMOReal x = myX * cos(rot) -myY * sin(rot) + xoff;
        SUMOReal y = myX * sin(rot) + yoff + myY * cos(rot);
        myX = x;
        myY = y;
    }


    friend std::ostream &operator<<(std::ostream &os, const Position2D &p) {
        os << p.x() << "," << p.y();
        return os;
    }

    bool operator==(const Position2D &p2) const {
        return myX==p2.myX && myY==p2.myY;
    }

    bool operator!=(const Position2D &p2) const {
        return myX!=p2.myX || myY!=p2.myY;
    }


    bool almostSame(const Position2D &p2, SUMOReal maxDiv=POSITION_EPS) const {
        return fabs(myX-p2.myX)<maxDiv && fabs(myY-p2.myY)<maxDiv;
    }


    inline SUMOReal distanceTo(const Position2D &p2) const {
        return sqrt(distanceSquaredTo(p2));
    }


    inline SUMOReal distanceSquaredTo(const Position2D &p2) const {
        return (myX-p2.myX)*(myX-p2.myX) + (myY-p2.myY)*(myY-p2.myY);
    }


private:
    SUMOReal myX;

    SUMOReal myY;

};


#endif

/****************************************************************************/