#include "bbUtilitiesDistanceLenght.h"
#include "bbUtilitiesPackage.h"
namespace bbUtilities
{

BBTK_ADD_BLACK_BOX_TO_PACKAGE(Utilities,DistanceLenght)
BBTK_BLACK_BOX_IMPLEMENTATION(DistanceLenght,bbtk::AtomicBlackBox);
void DistanceLenght::Process()
{

    std::vector<int> point0 = bbGetInputPoint0();
	std::vector<int> point1 = bbGetInputPoint1();
	int pointNum = bbGetInputPointNumber();
    
	if(!point0.empty()&&pointNum==0){
		x0 = point0[0];
		y0 = point0[1];
		z0 = point0[2];		
	}
	if(!point1.empty()&&pointNum==1){
		x1 = point1[0];
		y1 = point1[1];
		z1 = point1[2];
	}
	if(x0!=-1&&y0!=-1&&z0!=-1&&x1!=-1&&y1!=-1&&z1!=-1){
        double dist = sqrt(pow(x0-x1, 2)+pow(y0-y1, 2)+pow(z0-z1, 2));
		std::cout<<"Distance = "<<dist<<std::endl;
		bbSetOutputOut(dist);
		x0 = -1;
		y0 = -1;
		z0 = -1;
		x1 = -1;
		y1 = -1;
		z1 = -1;
	}	 
}
void DistanceLenght::bbUserSetDefaultValues()
{
	x0=-1;
	y0=-1;
	z0=-1;
	x1=-1;
	y1=-1;
	z1=-1;
	bbSetOutputOut(0);

}
void DistanceLenght::bbUserInitializeProcessing()
{

}
void DistanceLenght::bbUserFinalizeProcessing()
{

}
}
// EO namespace bbUtilities