                 //Serial.print("report");
               }
               break;
-              
-            break;
+            case 'C':
+              if(command_status == 1){
+                get_cap_value();
+              }
+              break;
+            
             default:
               //Serial.print("Hello11");
             break;


#define ULTRA_FREQUENCY 10

#define IRA 7
#define IRB 6




  Serial.print('-');
  Serial.print(ultrasonic2);
  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(){
