void PointSetCompare(mitk::PointSet::Pointer pointSet2,
mitk::PointSet::Pointer pointSet1, bool& /*identical*/)
{
MITK_TEST_CONDITION(pointSet1->GetSize() == pointSet2->GetSize(), "Testing if PointSet size is correct" );
for (unsigned int t = 0; t < numberOfTimeSeries; t++)
{
for (unsigned int i = 0; i < (unsigned int) pointSet1->GetSize(t); ++i)
{
mitk::Point3D p1 = pointSet1->GetPoint(i);
mitk::Point3D p2 = pointSet2->GetPoint(i);
//test
std::cout << "r point: " << p2 << std::endl;
std::cout << "w point: " << p1 << std::endl;
//test end
MITK_TEST_CONDITION((p1[0] - p2[0]) <= 0.0001, "Testing if X coordinates of the Point are at the same Position" );
MITK_TEST_CONDITION((p1[1] - p2[1]) <= 0.0001, "Testing if Y coordinates of the Point are at the same Position" );
MITK_TEST_CONDITION((p1[2] - p2[2]) <= 0.0001, "Testing if Z coordinates of the Point are at the same Position" );
}
}
// testing geometry
MITK_TEST_CONDITION( mitk::Equal( *(pointSet1->GetGeometry()), *(pointSet2->GetGeometry()), 0.000001, true),
"Restored geometry must equal original one.");
}
std::vector<mitk::Point3D> PointSetToVector(const mitk::PointSet::Pointer & mps)
{
std::vector<mitk::Point3D> result;
for(int i = 0 ; i < mps->GetSize(); i++)
result.push_back(mps->GetPoint(i));
return result;
}
double mitk::StaticIGTHelperFunctions::ComputeFRE(mitk::PointSet::Pointer imageFiducials, mitk::PointSet::Pointer realWorldFiducials, vtkSmartPointer<vtkLandmarkTransform> transform)
{
if (imageFiducials->GetSize() != realWorldFiducials->GetSize()) return -1;
double FRE = 0;
for (int i = 0; i < imageFiducials->GetSize(); i++)
{
itk::Point<double> current_image_fiducial_point = imageFiducials->GetPoint(i);
if (transform != NULL)
{
current_image_fiducial_point = transform->TransformPoint(imageFiducials->GetPoint(i)[0], imageFiducials->GetPoint(i)[1], imageFiducials->GetPoint(i)[2]);
}
double cur_error_squared = current_image_fiducial_point.SquaredEuclideanDistanceTo(realWorldFiducials->GetPoint(i));
FRE += cur_error_squared;
}
FRE = sqrt(FRE / (double)imageFiducials->GetSize());
return FRE;
}
inline static mitk::Image::Pointer CreateTestImageWithPointSet(mitk::ScalarType pixelValue, unsigned int dimX, unsigned int dimY, mitk::PointSet::Pointer subSet)
{
typedef itk::Image<mitk::ScalarType,2> ItkImageType2D;
typedef itk::ImageRegionIterator<ItkImageType2D> ItkImageRegionIteratorType2D;
ItkImageType2D::Pointer image = ItkImageType2D::New();
ItkImageType2D::IndexType start;
start[0] = 0;
start[1] = 0;
ItkImageType2D::SizeType size;
size[0] = dimX;
size[1] = dimY;
ItkImageType2D::RegionType region;
region.SetSize(size);
region.SetIndex( start);
ItkImageType2D::SpacingType spacing;
spacing[0] = 1.0;
spacing[1] = 1.0;
image->SetRegions( region );
image->SetSpacing ( spacing );
image->Allocate();
//Obtaining image data from ToF camera//
//Correlate inten values to PixelIndex//
ItkImageRegionIteratorType2D imageIterator(image,image->GetLargestPossibleRegion());
imageIterator.GoToBegin();
while (!imageIterator.IsAtEnd())
{
imageIterator.Set(pixelValue);
++imageIterator;
}
// distances varying from pixelValue
std::vector<mitk::ScalarType> distances;
distances.push_back(50);
distances.push_back(500);
distances.push_back(2050);
distances.push_back(300);
// set the pixel values for the subset
for (unsigned int i=0; i<subSet->GetSize(); i++)
{
mitk::Point3D point = subSet->GetPoint(i);
ItkImageType2D::IndexType index;
index[0] = point[0];
index[1] = point[1];
mitk::ScalarType distance = distances.at(i);
image->SetPixel(index,distance);
}
mitk::Image::Pointer mitkImage = mitk::Image::New();
mitk::CastToMitkImage(image,mitkImage);
return mitkImage;
}
bool PointSetsEqual(mitk::PointSet::Pointer pointSet1, mitk::PointSet::Pointer pointSet2)
{
bool pointSetsEqual = true;
if (pointSet1->GetSize()==pointSet2->GetSize())
{
for (unsigned int i=0; i<pointSet1->GetSize(); i++)
{
mitk::Point3D expectedPoint = pointSet1->GetPoint(i);
mitk::Point3D resultPoint = pointSet2->GetPoint(i);
if (!mitk::Equal(expectedPoint,resultPoint))
{
pointSetsEqual = false;
}
}
}
else
{
pointSetsEqual = false;
}
return pointSetsEqual;
}
void TestCreateOperationAndAddPoint()
{
int id = 0;
mitk::Point3D point;
point.Fill(1);
doOp = new mitk::PointOperation(mitk::OpINSERT, point, id);
pointSet->ExecuteOperation(doOp);
CPPUNIT_ASSERT_EQUAL_MESSAGE("check if added points exists",
true, pointSet->GetSize()==4 && pointSet->IndexExists(id));
mitk::Point3D tempPoint;
tempPoint.Fill(0);
tempPoint = pointSet->GetPoint(id);
CPPUNIT_ASSERT_EQUAL_MESSAGE("check if added point contains real value",
true, point == tempPoint);
}