 
 void robot_motorStart(uint8_t wheel)
 {
-    #if DEBUG
+    #if DEBUGMODE
     Serial.println("# Motor start");
     #endif
 


void robot_quickStop(uint8_t wheel)
{
    #if DEBUG
    Serial.println("# Motor quickstop");
    #endif


    return nodeAdress[wheel];
}

void robot_velocityMode(uint8_t wheel)
{
    #if DEBUGMODE
    Serial.println("# Motor velocity mode");
    #endif

