Updated robotNav for Potential Fields 2