 SoftwareSerial mySerial(2, 255);    //used for gps rx and tx pins in use
 
 //Minimum distance in meters to get to the current waypoint before heading to the next
-#define MIN_DISTANCE 1
+#define MIN_DISTANCE 2
 
 //Compass Stuff
 LSM303 compass;

 }
 
 float formatDistance(int meters){
  return meters / (float) 1000;
 }
 
  void gpsdump(TinyGPS &gps){

   int distance = getDistance(mCurrentWayPoint, flat, flon);
   
   //Check if distance is less then 2 meters
   if(distance <= MIN_DISTANCE){
     lcd2.setCursor(0,3);
     //Advance to next way point
     mCurrentWayPoint++;
