Quadrotor simulation for truncated gaussian