fixed other bug (yes, i should debug locally :p) in getCurrentWayPoint