Implementation for thrust ...

... a part at least
Cleaning up and modifying QuadcopterThrust
QuadcopterThrust done
checkAndFix thrust, double to unsigned int
Todo carina, fixed/ broke moveUp