 Servo penServo;
 
 float wheel_dia=63; //    # mm (increase = spiral out)
-float wheel_base=113; //    # mm (increase = spiral in, ccw) 
+float wheel_base=112; //    # mm (increase = spiral in, ccw) 
 //int steps_rev=128; //        # 512 for 64x gearbox, 128 for 16x gearbox
 int steps_rev=512;
 int delay_time=2; //         # time between steps in ms
 
+#define LED 3
+#define SWITCH 2
 // Stepper sequence org->pink->blue->yel
 int L_stepper_pins[] = {12, 10, 9, 11};
 int R_stepper_pins[] = {4, 6, 7, 5};



void loop(){ // draw a calibration box 4 times
  pendown();
  for(int x=0; x<12; x++){
    forward(100);

  }
  penServo.attach(servoPin);
  Serial.println("setup");
  pinMode( SWITCH, INPUT_PULLUP);
  pinMode( LED, OUTPUT );
  penup();
  
  delay(1000);
