Add back zero integral error on flight mode switch and change a bit defa...

...ult PID setting