No errors, old functions removed, position and heading hard coded