Added anti-wind up in normal PI, changed a little bit PI by Prof Land
Mavlink log msg added
Added some other log messages to QGC
Added variable structure proportional integral (VS-PI) controller