added heading stabilization, untested