[x] Make CGraphSlamEngine structures more generic - handle both CPose2D, CPose3D via the pose_t template argument
[x] Extend CFixedIntervalsNRD to register 3D constraints as well
[x] Visualization changes in the optimization procedure (CLevMarqGSO class)
[ ] Visualization changes in the ERDs (e.g., try to visualize laser scans in 2D cases only; resort to CObservation3DRangeScans in 3D cases). This should be done in their common parent to avoid code duplication
[ ] CLoopCloserERD, CICPCriteriaERD to register 3D constraints between non-consecutive nodes in the graph
[ ] Visualize the images when using a Kinect
[ ] Visualize ground truth in 3D scenarios
[ ] Record new online dataset with kinnect and run with that to verify the procedure - see rawlog-grabber
CLevMarqGSO
class)@babisp