   Serial.println();
 
   current_buffer[0] = 0;
-  is_command_running = 0;
-
-  //motors_control.add_sensor(0, senTypePotentiometer, 0); // THIS IS ONLY FOR TEST PURPOSE
 }
 
 //--------------------------------------------------------------------------------------------

        int motor_index, num_steps;
        sscanf(tmp_str + i + 1, "%d%d", &motor_index, &num_steps);
        motors_control.move_motor(motor_index, num_steps);
        is_command_running = 1;
        i += 3;
      }

      i++;
  }
}
//--------------------------------------------------------------------------------------------
//Main loop
void loop() {

  if (Serial.available() || current_buffer[0]) {
    int num_read = 0;
    char serial_buffer[65];

    num_read = Serial.readBytes(serial_buffer, 64); //Read up to 64 bytes
    serial_buffer[num_read] = 0;// terminate the string
    if (serial_buffer[0] || current_buffer[0]){
      strcat(current_buffer, serial_buffer);
      
      #ifdef DEBUG
        Serial.write("initial buffer is=");
