   if (strcmp(cmd, "00") == 0) {
       sm(pin, val);
   } else if (strcmp(cmd, "01") == 0) {
-      dw(pin, val);
+      dw(pin, val); // digital write
   } else if (strcmp(cmd, "02") == 0) {
-      dr(pin, val);
+      dr(pin, val); //  digital read
+  } else if (strcmp(cmd, "98") == 0) {
+      handleServo(pin, val, aux);
   } else if (strcmp(cmd, "99") == 0) {
       toggleDebug(val);
   }

  Serial.println(m);
}


  pin[2] = '\0';
  strncpy(val, messageBuffer + 4, 2);
  val[2] = '\0';
  strncpy(aux, messageBuffer + 6, 3);
  aux[2] = '\0';
  
  if (debug) {
    Serial.println(messageBuffer);
