lots of work on altitude control, UNTESTED