// Cyphesis Online RPG Server and AI Engine
// Copyright (C) 2009 Alistair Riddoch
//
// 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 Street, Fifth Floor, Boston, MA 02110-1301 USA


#ifdef NDEBUG
#undef NDEBUG
#endif
#ifndef DEBUG
#define DEBUG
#endif

#include "physics/Vector3D.h"

#include <wfmath/point.h>
#include <wfmath/vector.h>

#include <cassert>

int main() {
	Point3D point1(0, 0, 0), point2(1, 1, 1);

	assert(squareDistance(point1, point2) > 1);

	std::vector<double> empty, point_store, vector_store;

	addToEntity(point1, point_store);

	Vector3D vector1(0, 0, 0);

	addToEntity(vector1, vector_store);

	assert(fromStdVector(point1, empty) == -1);
	assert(fromStdVector(vector1, empty) == -1);

	assert(fromStdVector(point1, point_store) == 0);
	assert(fromStdVector(vector1, vector_store) == 0);

	sqrMag(point1);
	sqrMag(point2);

	return 0;
}
