Adding PID for height
Merge branch 'master' of https://github.com/mikh/Quadcopter-Simulation