bug fixes
Stabilized PID
updates
Merge branch 'master' into develop

Conflicts:
	PILOT/servo.cpp
Merge latest working vesion
Merge branch 'master' of https://github.com/vjaunet/QUADCOPTER into develop

Conflicts:
	PILOT/servo.cpp