linien.cpp

Go to the documentation of this file.

// -*- mode: c++; indent-tabs-mode: nil; c-basic-offset: 4; coding: iso-8859-1; -*-

/*
ACT-CV - Machine Vision for Cognitive Modeling
Copyright (c) 2008 Marc Halbruegge

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.

This program is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
GNU General Public License for more details.

You should have received a copy of the GNU General Public License
along with this program; if not, write to the Free Software
Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
*/

#include <iostream>
using namespace std;

#include "linien.h"

#define _USE_MATH_DEFINES
#include <cmath>

#ifndef _PI
# ifdef M_PI
#  define _PI M_PI
# else
#  define _PI 3.1415926536
#  ifndef M_PI
#   define M_PI 3.1415926536
#  endif
# endif
#endif


ostream& operator << (ostream &out, const Linie &linie) {
    //noch normieren für die Ausgabe:
    double l,r,o,u;

    if (linie.GetLinks()==linie.GetRechts()) {
        l=r=linie.GetRechts();
        if (linie.GetOben() > linie.GetUnten()) {
            o=linie.GetOben(); u=linie.GetUnten();
        } else {
            u=linie.GetOben(); o=linie.GetUnten();
        }
    } else {
        if (linie.GetRechts() > linie.GetLinks()) {
            l=linie.GetLinks(); o=linie.GetOben();
            r=linie.GetRechts(); u=linie.GetUnten();
        } else {
            r=linie.GetLinks(); u=linie.GetOben();
            l=linie.GetRechts(); o=linie.GetUnten();
        }
    }
  
    out << l << " " << o << " " 
        << r << " " << u;
  
    return out;
}

// difference of two angles in [-pi/2;pi/2]
double GetWinkelDiff(double w1, double w2) {
    double result=w2-w1;
    while (result < -M_PI/2) result+=M_PI;
    while (result > M_PI/2) result-=M_PI;
    return result;        
}