           //    haveRemoteCmd, remoteCmd.left, remoteCmd.right, remoteCmd.key);
 
               if (remoteControlled()) {
+                // send the current distance to the raspberry
+                Serial.print("distance: ");
+                Serial.println(distance);
+                
+                // Check if we received a command
                 if (haveRemoteCmd) {
                   switch (remoteCmd.key) {
                     case RemoteControlDriver::command_t::keyF1:

                      break;
                  case RemoteControlDriver::command_t::keyNone:
                      // this is a directional command
                      leftMotors.setSpeed(remoteCmd.left);
                      rightMotors.setSpeed(remoteCmd.right);
                      break;

            void initialize()
            {
                Serial.println("Initializing robot");
                leftMotors.setSpeed(0);
                rightMotors.setSpeed(0);
                state = stateRemote;
            }


