Fixed bug in DStarPath demo that won't allow rover to continually move straight