         for (int i=0;i<SERVO_NUM;i++) {
           if (flags & (1<<i)) {
             myServos[i].value = data[i+2];
+#ifdef DUMP_PACKET
             gDebug.print("Servo idx=");
             gDebug.print(i, DEC);
             gDebug.print(", value=");
             gDebug.print(myServos[i].value, HEX);
             gDebug.print("\n");
+#endif
           }
         }
 //        if (flags & (1<<SERVO_NUM)) {

    }
    SoftwareServo::refresh();
  }
  delay(10);
}

void handleRecvPacket(unsigned char packetType, unsigned char opCode, int dataLen, unsigned char* data) {

      } else {
        for (int i=0;i<SERVO_NUM;i++) {
          myServos[i].value = data[i];
#ifdef DUMP_PACKET
          gDebug.print("Servo idx=");
          gDebug.print(i, DEC);
          gDebug.print(", value=");
          gDebug.print(myServos[i].value, HEX);
          gDebug.print("\n");
#endif
        }
      }
//    } else if (opCode == 2) {
