  * Handle Ping commands
  * fire, read
  */
-void handlePing(char *pin, char *val, char *aux) {
-  int p = getPin(pin);
-  if (p == -1) return;
-  
+void handlePing(int p, char *val, char *aux) {  
   // 01(1) Fire and Read
   if (atoi(val) == 1) {
     char m[16];

 * Handle Servo commands
 * attach, detach, write, read, writeMicroseconds, attached
 */
void handleServo(char *pin, char *val, char *aux) {
  int p = getPin(pin);
  if (p == -1) return;
  
  // 00(0) Detach
  if (atoi(val) == 0) {
    servo.detach();

/*
 *  Basic reads and writes
 */
void dWrite(int p, char *val) {
  pinMode(p, OUTPUT);
  if (atoi(val) == 0) {
    digitalWrite(p, LOW);
