Method 1 (mw-based) and Method 2 (crazyflie-based) coded.

The PIDs need tunning. The method 2 seems more promising.
Tests should be done