Code for formation flight of small UAVs using vision-based localization