adding and revise PID widget
add ahrs
finishing ControlPID
phase 2
 fixing everything and adding to main window