crosbot_explore: waypoint search doesn't necesarily go to first waypoint to...

crosbot_explore: waypoint search doesn't necesarily go to first waypoint to avoid synchonisation issues with robot moving after path is calculated