initial code for testing crazyflie (works!)