From be3d8fcca9f0cbc07ee97b54330c10ece611b8ff Mon Sep 17 00:00:00 2001
From: vahrenkamp <vahrenkamp@042f3d55-54a8-47e9-b7fb-15903f145c44>
Date: Fri, 23 Mar 2012 09:30:12 +0000
Subject: [PATCH] bugfix

git-svn-id: http://svn.code.sf.net/p/simox/code/trunk@223 042f3d55-54a8-47e9-b7fb-15903f145c44
---
 MotionPlanning/PostProcessing/ShortcutProcessor.cpp | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/MotionPlanning/PostProcessing/ShortcutProcessor.cpp b/MotionPlanning/PostProcessing/ShortcutProcessor.cpp
index 922cbb9bf..55cabbc74 100644
--- a/MotionPlanning/PostProcessing/ShortcutProcessor.cpp
+++ b/MotionPlanning/PostProcessing/ShortcutProcessor.cpp
@@ -74,7 +74,7 @@ int ShortcutProcessor::doShortcut( int startIndex, int endIndex )
 	optimizedPath->print();*/
 
 	Eigen::VectorXf s = optimizedPath->getPoint(startIndex);
-	Eigen::VectorXf e = optimizedPath->getPoint(endIndex);
+	Eigen::VectorXf e = optimizedPath->getPoint(startIndex+1);
 
 	// create intermediate path		
 	CSpacePathPtr intermediatePath = cspace->createPath(s, e);
-- 
GitLab