1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162
|
/*=========================================================================
Program: Image Guided Surgery Software Toolkit
Module: $RCSfile: igstkMouseTrackerTest.cxx,v $
Language: C++
Date: $Date: 2010-12-17 22:43:50 $
Version: $Revision: 1.15 $
Copyright (c) ISC Insight Software Consortium. All rights reserved.
See IGSTKCopyright.txt or http://www.igstk.org/copyright.htm for details.
This software is distributed WITHOUT ANY WARRANTY; without even
the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR
PURPOSE. See the above copyright notices for more information.
=========================================================================*/
#if defined(_MSC_VER)
// Warning about: identifier was truncated to '255' characters
// in the debug information (MVC6.0 Debug)
#pragma warning( disable : 4786 )
#endif
#include <iostream>
#include <fstream>
#include <FL/Fl.H>
#include <FL/Fl_Window.H>
#include "igstkLogger.h"
#include "itkStdStreamLogOutput.h"
#include "igstkMouseTracker.h"
#include "igstkMouseTrackerTool.h"
#include "igstkTransform.h"
#include "igstkTransformObserver.h"
class MouseTrackerTestCommand : public itk::Command
{
public:
typedef MouseTrackerTestCommand Self;
typedef itk::Command Superclass;
typedef itk::SmartPointer<Self> Pointer;
itkNewMacro( Self );
protected:
MouseTrackerTestCommand() {};
public:
void Execute(itk::Object *caller, const itk::EventObject & event)
{
Execute( (const itk::Object *)caller, event);
}
void Execute(const itk::Object * itkNotUsed(object), const itk::EventObject & event)
{
// don't print "CompletedEvent", only print interesting events
if (!igstk::CompletedEvent().CheckEvent(&event) &&
!itk::DeleteEvent().CheckEvent(&event) )
{
std::cout << event.GetEventName() << std::endl;
}
}
};
int igstkMouseTrackerTest( int, char * [] )
{
igstk::RealTimeClock::Initialize();
typedef igstk::Transform TransformType;
typedef igstk::MouseTracker MouseTrackerType;
typedef igstk::Object::LoggerType LoggerType;
typedef itk::StdStreamLogOutput LogOutputType;
typedef igstk::TransformObserver ObserverType;
// logger object created for logging mouse activities
LoggerType::Pointer logger = LoggerType::New();
LogOutputType::Pointer logOutput = LogOutputType::New();
logOutput->SetStream( std::cout );
logger->AddLogOutput( logOutput );
logger->SetPriorityLevel( itk::Logger::DEBUG );
MouseTrackerTestCommand::Pointer
my_command = MouseTrackerTestCommand::New();
MouseTrackerType::Pointer tracker = MouseTrackerType::New();
tracker->SetLogger( logger );
// Test SetScaleFactor()/GetScaleFactor() methods
const double scale = 1.0;
tracker->SetScaleFactor( scale );
const double scaleReturned = tracker->GetScaleFactor();
if( fabs( scale - scaleReturned ) > 1e-5 )
{
std::cerr << "Error in SetScaleFactor()/GetScaleFactor() " << std::endl;
return EXIT_FAILURE;
}
tracker->Print( std::cout );
tracker->RequestOpen();
typedef igstk::MouseTrackerTool TrackerToolType;
typedef TrackerToolType::TransformType TransformType;
// instantiate and attach wired tracker tool
TrackerToolType::Pointer trackerTool = TrackerToolType::New();
trackerTool->SetLogger( logger );
std::string mouseName = "PS/s";
trackerTool->RequestSetMouseName( mouseName );
if ( mouseName != trackerTool->GetMouseName() )
{
std::cerr << "MouseName did not match!" << std::endl;
return EXIT_FAILURE;
}
//Configure
trackerTool->RequestConfigure();
//Attach to the tracker
trackerTool->RequestAttachToTracker( tracker );
//Add observer to listen to events throw by the tracker tool
trackerTool->AddObserver( itk::AnyEvent(), my_command);
ObserverType::Pointer coordSystemAObserver = ObserverType::New();
coordSystemAObserver->ObserveTransformEventsFrom( trackerTool );
tracker->RequestStartTracking();
typedef igstk::Transform TransformType;
typedef ::itk::Vector<double, 3> VectorType;
typedef ::itk::Versor<double> VersorType;
for(unsigned int i=0; i<20; i++)
{
TransformType transform;
VectorType position;
coordSystemAObserver->Clear();
trackerTool->RequestGetTransformToParent();
if (coordSystemAObserver->GotTransform())
{
transform = coordSystemAObserver->GetTransform();
position = transform.GetTranslation();
std::cout << "Mouse :"
<< trackerTool->GetTrackerToolIdentifier()
<< "\t\t Position = (" << position[0]
<< "," << position[1] << "," << position[2]
<< ")" << std::endl;
}
}
tracker->RequestStopTracking();
tracker->RequestClose();
//coverage
tracker->RequestReset();
return EXIT_SUCCESS;
}
|