48 lines
1.3 KiB
C++
48 lines
1.3 KiB
C++
/* -*- Mode:C++; c-basic-offset:8; tab-width:8; indent-tabs-mode:t -*- */
|
|
/*
|
|
* Copyright (c) 2006 INRIA
|
|
* All rights reserved.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation;
|
|
*
|
|
* 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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
*
|
|
* Author: Mathieu Lacage <mathieu.lacage@sophia.inria.fr>
|
|
*/
|
|
#include "position.h"
|
|
#include <math.h>
|
|
|
|
namespace yans {
|
|
|
|
Position::~Position ()
|
|
{}
|
|
|
|
void
|
|
Position::get (double &x, double &y, double &z) const
|
|
{
|
|
real_get (x,y,z);
|
|
}
|
|
double
|
|
Position::get_distance_from (Position const*position) const
|
|
{
|
|
double ox,oy,oz;
|
|
double x,y,z;
|
|
position->real_get (ox,oy,oz);
|
|
real_get (x,y,z);
|
|
double dx = ox - x;
|
|
double dy = oy - y;
|
|
double dz = oz - z;
|
|
return sqrt (dx*dx+dy*dy+dz*dz);
|
|
}
|
|
|
|
}; // namespace yans
|