Hover mode w/ pitch+roll+yaw control established

Yaw control was added so that airplane would try to maintain current
heading using rudder.