Implement first draft of drone control code