       break; 
       case btnDOWN:
         //Move menu down
-        if(mMenuPosition < MENU_LENGTH - 1){
+        if(mMenuPosition < MENU_LENGTH){
           mMenuPosition++;
         }
       break;

  }

  void loop(){ 
    //Read from gps
    if (feedgps()){
      //Dump gps if new data
      gpsdump(gps);
    }
    updateHeading();
    updateDisplay();
  }

  /**

    compassHeading = heading * 180/M_PI; 
  }
  
  void updateDisplay(bool newData){
    //Check if a button was pressed
    int btnPressed = read_LCD_buttons();
    
