FME Laser Navigation Given a path or map made by LaserScan and Pose
pairs, it should follow this path localisating itself using the icp between
the current LaserScan and the path one..
Args
shortest if true uses the shortest path as the map if false uses the safest