RobotDirection Removed, Display Added

Keeping robot direction and checking Euclidean distance is turned off
for better results. Added display function. Added tic and roc for
debugging.