/******************************************************************************\

CAMotics is an Open-Source simulation and CAM software.

Copyright (C) 2011-2019 Joseph Coffland <joseph@cauldrondevelopment.com>

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, see <http://www.gnu.org/licenses/>.

\******************************************************************************/

#include "AABBTree.h"

using namespace std;

using namespace cb;

using namespace CAMotics;

AABBTree::~AABBTree() {delete root;}

Rectangle3D AABBTree::getBounds() const {

if (!finalized) THROW("AABBTree not yet finalized");

return root ? root->getBounds() : Rectangle3D();

}

void AABBTree::insert(const GCode::Move *move, const Rectangle3D &bbox) {

if (finalized) THROW("Cannot insert into AABBTree after partitioning");

root = (new AABB(move, bbox))->prepend(root);

}

bool AABBTree::intersects(const Rectangle3D &r) const {

if (!finalized) THROW("AABBTree not yet finalized");

return root && root->intersects(r);

}

void AABBTree::collisions(const Vector3D &p,

vector<const GCode::Move *> &moves) const {

if (!finalized) THROW("AABBTree not yet finalized");

if (root) root->collisions(p, moves);

}

void AABBTree::finalize() {

if (finalized) return;

finalized = true;

root = new AABB(root);

}