proper rate based yaw, altitude correction linked to ch6