 without computer connected this line should be commented out. 
 */
 #define DEBUG_OUTPUT
-//#undef DEBUG_OUTPUT
+#undef DEBUG_OUTPUT
 
 #ifdef DEBUG_OUTPUT
 #define USE_SERIAL

  LocoNet.init(LOCONET_TX_PIN);
  
  uint8_t i = 0;
  uint8_t pin_config;
  uint16_t pin, address, pos1, pos2, speed, fbslot1, fbslot2;
  DEBUG("Max # of pins:");
  DEBUGLN(MAX);
   
  for (i = 0; i < MAX; i++) {
    pin_config = eeprom_read_byte((uint8_t*)&(_CV.pin_conf[i]));
    pin   = eeprom_read_word((uint16_t*)&(_CV.conf[i].servo.arduinopin));
    address = eeprom_read_word((uint16_t*)&(_CV.conf[i].servo.address));
    switch (pin_config) {
      case 2: //Servo
        //ServoSwitch(i,0);
        pos1  = eeprom_read_word((uint16_t*)&(_CV.conf[i].servo.pos1));
        pos2  = eeprom_read_word((uint16_t*)&(_CV.conf[i].servo.pos2));
        speed = eeprom_read_word((uint16_t*)&(_CV.conf[i].servo.speed));
        fbslot1  = eeprom_read_word((uint16_t*)&(_CV.conf[i].servo.fbslot1));
        fbslot2  = eeprom_read_word((uint16_t*)&(_CV.conf[i].servo.fbslot2));
        confpins[i] = new ServoSwitch(i, pin, address, pos1, pos2, speed, servoEnablePin, fbslot1, fbslot2);
		    confpins[i]->restore_state(eeprom_read_word((uint16_t*)&(_CV.conf[i].servo.state)));
        break;
      case 1: // Input
        confpins[i] = new InputPin(i, pin, address);
        break;
      default:
        confpins[i] = new ConfiguredPin(i, pin, address);
        break;
    }
    DEBUG("Pin #");
    DEBUGLN(i);
    confpins[i]->print();
  }
  programmingMode = false;
}

      DEBUG((uint8_t)lncvValue);
      write_cv(&_CV, lncvAddress, lncvValue);      
      DEBUG(read_cv(&_CV, lncvAddress));
      uint8_t slot = cv2slot(lncvAddress);
      delete(confpins[slot]);
      configureSlot(slot);
      //lncv[lncvAddress] = lncvValue;
      return LNCV_LACK_OK;
    }
