 Me_InfraredReceiver infraredReceiver; /* Note: As the code need to use interrupt 0, it works only when the Me - Infrared Receiver module is connected to the port 4(PORT_4) of Me - Base Shield. */
 Me_UltrasonicSensor ultraSensor( PORT_5 ); //Ultrasonic module can ONLY be connected to port 3, 4, 5, 6, 7, 8 of base shield. ultraSensor.distanceCm()
 MakeblockStepper moveItemStepper( 3200, baseShield, PORT_3 );
-Me_ServoDriver servoDriver(PORT_2); //can ONLY be PORT_1,PORT_2
+Me_ServoDriver servoDriver( PORT_2 ); //can ONLY be PORT_1,PORT_2
+
+int SERVO1_UP = 130;
+int SERVO1_DOWN = 115;
 
 void setup() {
   // Initailize FSM

  ultraSensor.begin();
  moveItemStepper.setSpeed( 12 );
  servoDriver.Servo1_begin();
  servoDriver.writeServo1( 90 );  
}

void loop() {
  int remoteKey = infraredReceiver.read();
  int usDistance = ultraSensor.distanceCm();
  int stopMicroSwitch = baseShield.readMePortOutsidePin( PORT_8 ); 
  
  switch ( fsmState ) {
    case STATE_OFF:
      Serial.println( "OFF" ); 

#include <Me_InfraredReceiver.h>
#include <Me_UltrasonicSensor.h>
#include "MakeblockStepper.h"
#include <AccelStepper.h>
#include <Servo.h>
#include <Me_ServoDriver.h>

