   nodeId[1] = '0' + min(digit2,9);
   pollingInterval = ((PINB & 0x06) >> 1) ^ 0x03;
 
+  Serial.println("Debug: ");
+  Serial.print("Port B: ");
   Serial.println(PINB,HEX);
+  Serial.print("Port C: ");
   Serial.println(PINC,HEX);
   
+  Serial.print("Polling Interval: ");
   Serial.println(pollingInterval,DEC);
 
-  Serial.println(digit1,DEC);
+  Serial.print("Node ID Digits: ");
+  Serial.print(digit1,DEC);
+  Serial.print(" ");
   Serial.println(digit2,DEC);
   // A0, A1 are first part, R, S, T, W
   // A2 - A5 are 0-9, A-F

// Some functions to get the configured node address and polling
void readJumpers() {
  // Set analog input pins to read digital values, set internal pullup
  // ugly - refactor in loop.
  pinMode(A0, INPUT);
  pinMode(A1, INPUT);
  pinMode(A2, INPUT);

    LLAP.sendInt("ERR",val); // Diagnostic
    delay(5000);	// try again in 5 seconds
  }

  // Repeat "STARTED" message 5 times to alert
  for(int i=0;i<5;i++) {
    LLAP.sendMessage("STARTED");
    delay(1000);
  }

}

// The main loop, we basically wake up the SRF, take a reading, transmit reading then go back to sleep
void loop() {

  // Determine if we need to send a battery voltage reading or a distance reading
  if( --batteryCountDown <= 0 ) {
    int mV = readVcc();
    LLAP.sendIntWithDP("B", mV, 3 );
    batteryCountDown = BATTERY_READ_INTERVAL;
  } 
  else {

    // Distance reading
    uint16_t cm = getRange();
    // Send temperature reading
    if( tempSensorFound ) {
