#define armsensor_port 15
#define rightservo 1
#define leftservo 2
#define down_right 180
#define down_left 3700
#define up_right 900
#define up_left 3000
#define box_right 1787 /* was 1800 */
#define box_left 1938 /* was 1925 */
int armmode;

void arm(int mode) {
  if(mode==0) {
    servo(rightservo,down_right);
    servo(leftservo,down_left);
  } else if(mode==1) {
    servo(rightservo,up_right);
    servo(leftservo,up_left);
  } else {
    servo(rightservo,box_right);
    servo(leftservo,box_left);
  }
}