Matlab code to automatically control drones in a windy environment