MEDefs.cpp

/*
 *  This file is part of the AiBO+ project
 *
 *  Copyright (C) 2005-2016 Csaba Kertész (csaba.kertesz@gmail.com)
 *
 *  AiBO+ 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.
 *
 *  AiBO+ 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., 59 Temple Street #330, Boston, MA 02111-1307, USA.
 *
 */

#include "MEDefs.hpp"

#include <boost/math/constants/constants.hpp>

#include <math.h>

MEColor::MEColor(unsigned char red, unsigned char green, unsigned char blue) :
  Red(red), Green(green), Blue(blue)
{
}


MEPoint::MEPoint(int x, int y) : X(x), Y(y)
{
}


bool MEPoint::IsValid() const
{
  return X >= 0 && Y >= 0;
}


float MEGetInteriorAngle(const MEPoint& point1, const MEPoint& point2, const MEPoint& point3)
{
  float p12 = sqrt((float)((point1.X-point3.X)*(point1.X-point3.X)+(point1.Y-point3.Y)*(point1.Y-point3.Y)));
  float p13 = sqrt((float)((point1.X-point2.X)*(point1.X-point2.X)+(point1.Y-point2.Y)*(point1.Y-point2.Y)));
  float p23 = sqrt((float)((point3.X-point2.X)*(point3.X-point2.X)+(point3.Y-point2.Y)*(point3.Y-point2.Y)));

  return (float)acos((p12*p12+p13*p13-p23*p23) / (2*p12*p13))*180 / boost::math::constants::pi<float>();
}


MEPoint MEComputeLineIntersection(const MEPoint& line1_point1, const MEPoint& line1_point2,
                                  const MEPoint& line2_point1, const MEPoint& line2_point2)
{
  int x1 = line1_point1.X;
  int y1 = line1_point1.Y;
  int x2 = line1_point2.X;
  int y2 = line1_point2.Y;
  int x3 = line2_point1.X;
  int y3 = line2_point1.Y;
  int x4 = line2_point2.X;
  int y4 = line2_point2.Y;
  int Distance = (x1-x2)*(y3-y4)-(y1-y2)*(x3-x4);

  if (Distance)
  {
    MEPoint Point;

    Point.X = (int)((float)((x1*y2-y1*x2)*(x3-x4)-(x1-x2)*(x3*y4-y3*x4)) / Distance);
    Point.Y = (int)((float)((x1*y2-y1*x2)*(y3-y4)-(y1-y2)*(x3*y4-y3*x4)) / Distance);
    return Point;
  }
  return MEPoint(-1, -1);
}