stabilize module marked as taken from the crazyflie code - the performance is not good