   //Attache the servo on the PWM pin;
   servo_clamp.attach(SERVO_CLAMP_PIN);
   servo_push.attach(SERVO_PUSH_PIN);
-  servo_stack.attach(SERVO_STACK_PIN);
+  //servo_stack.attach(SERVO_STACK_PIN);
 }
 
 void loop() {
-process_action(servo, action);
+  process_action(servo, action);
 }
 
 void receive_data(int byte_count) {


//Clamp servo const 
const int SERVO_CLAMP_PIN = 9; 
const int SERVO_PUSH_PIN = 10; //TO DEFINE
const int SERVO_PUSH_PIN = 11; 
const int CLAMP_OPEN_ANGLE = 0;
const int CLAMP_CLOSE_ANGLE = 180; 
Servo servo_clamp;
Servo servo_push;
Servo servo_stack; 

int servo;
int action;


      break;
    case 2: 
      if (action == 0) {
        change_servo_angle(&servo_push, PUSH_BACK);
      } 
      else if (action == 1) {
        change_servo_angle(&servo_push, PUSH_OUT);
      }
      break;   
   default : 
     break; //do something when value is not right?   
  } 
}

//Use a specifique servo and give it an angle
void change_servo_angle(Servo *servo, int angle) {
