1 files changed, 9 insertions, 5 deletions
diff --git a/main.vala b/main.vala
index d398367..790e0fc 100644
--- a/main.vala
+++ b/main.vala
@@ -45,14 +45,18 @@ int main(string[] args) {
 		cfg = new Config();
 		Log.init();
 
-		//gyroscope     = cfg.get_gyroscope();
-		//accelerometer = cfg.get_accelerometer();
-		//compass       = cfg.get_compass();
-		//barometer     = cfg.get_barometer();
-		//motorCtrl     = cfg.get_motor_controller();
+		gyroscope     = cfg.get_gyroscope();
+		accelerometer = cfg.get_accelerometer();
+		compass       = cfg.get_compass();
+		barometer     = cfg.get_barometer();
+		motorCtrl     = cfg.get_motor_controller();
 		model         = cfg.get_model();
 		receiver      = cfg.get_receiver();
 
+		receiver.set_speed.connect((id, speed) => {
+			motorCtrl.set_single(id, speed);
+		});
+
 		kinematics   = new Kinematics(0, 0); // TODO: Compass
 		flightCtrl   = new FlightControl();