Changed pitch to use z-dist error in follower's body frame  Throttle OK