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

// 

#include <Servo.h>


Servo penServo;

float wheel_dia=63; //    # mm (increase = spiral out)
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};
