added missing Roll+Pitch VBarSensitivity & Roll+Pitch Vbar.Kp,Ki,Kd
Reorganized code as requested.