diff --git a/executables/hokuyo/driver/src/urgDriverCompute.cpp b/executables/hokuyo/driver/src/urgDriverCompute.cpp
index 855bfc0..2faa671 100644
--- a/executables/hokuyo/driver/src/urgDriverCompute.cpp
+++ b/executables/hokuyo/driver/src/urgDriverCompute.cpp
@@ -120,10 +120,10 @@ void UrgDriver::interpretData(const std::vector<long> & data, int n)
 			}
 			else
 			{
-				// if(checkPointBot(bot.front(), c))
-				// {
+				if(checkPointBot(bot.front(), c))
+				{
 					bot.push_front(c);
-				// }
+				}
 				else
 				{
 					coord res = computeBotLocation(bot);