Changed waypoint-positions to float