refactoring multi-uav initialization (has errors)
refactoring multi-uav initialization (has errors)

darknight-007/Firmware,darknight-007/Firmware,darknight-007/Firmware,darknight-007/Firmware,darknight-007/Firmware