Ground path follower: small fixes