+#include <RunningMedian.h>
 #include <CapacitiveSensor.h>
 #include <EnableInterrupt.h>
 #include <NewPing.h>

  Serial.print("&");
}

void get_cap_value() {
  int i;
  long cap = capSense.capacitiveSensorRaw(30);
  long capAvg;

  for (i = 0, capAvg = 0; i < 100; i++) {
    capAvg += cap;
  }
  Serial.print(capAvg/100);
  Serial.print('-');
  //return capAvg/100;
}

void servo_info(){

Servo myservo;
I2CEncoder encoder_B;
I2CEncoder encoder_A;
CapacitiveSensor cap_sense = CapacitiveSensor(CAP_SEND,CAP_REC); // (send_pin, receive_pin);



