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


#define ULTRA_FREQUENCY 10

#define IRA 7
#define IRB 6




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