Simplified autonomous navigation. Only use GPS estimation for heading.