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

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

        //pinMode(IRA, INPUT_PULLUP);
        //pinMode(IRB, INPUT_PULLUP);

        //encoder_A.init(MOTOR_393_SPEED_ROTATIONS,MOTOR_393_TIME_DELTA);
        //encoder_B.init(MOTOR_393_SPEED_ROTATIONS,MOTOR_393_TIME_DELTA);
        
        enableInterrupt(stop_button, stop_motor_ALL , CHANGE); 
        //enableInterrupt(IRA,encoderA,CHANGE);
