diff --git a/quad/src/quad_app/control_algorithm.c b/quad/src/quad_app/control_algorithm.c
index ef2c6e2edc04c1d91d136cb074d67dee2e14cecc..59f4cbf6e39e81da5841708a76b4acecf3cdcbd3 100644
--- a/quad/src/quad_app/control_algorithm.c
+++ b/quad/src/quad_app/control_algorithm.c
@@ -375,7 +375,7 @@ int control_algorithm_init(parameter_t * ps)
     graph_set_param_val(graph, ps->pos_time, CONST_SET, 0.04);
     graph_set_param_val(graph, ps->angle_time, CONST_SET, 0.005);
     // Set initial mode
-    connect_manual(ps);
+    connect_autonomous(ps);
 
     return 0;
  }