Working on some altitude limiting code