Ap mount speedup

Simple update to make APM2.6 run faster with brushless gimbals. Removes an ATAN2 calc if no Yaw control is needed.
Don't pull in the AC_Heli patch. That was an accident.