Merge pull request #5837 from thinkyhead/rc_fix_mbl_homing

Fix broken homing in MBL

Marlin/ultralcd.cpp

     lcd_goto_screen(old_screen);
   }
 
-  inline void lcd_wait_for_homing() {
-    no_reentrance = true;
-    while (!axis_homed[X_AXIS] || !axis_homed[Y_AXIS] || !axis_homed[Z_AXIS]) idle();
-    no_reentrance = false;
-  }
-
   void lcd_return_to_status() { lcd_goto_screen(lcd_status_screen); }
 
   void lcd_save_previous_screen() {
           LCDVIEW_CALL_NO_REDRAW
         #endif
       ;
-      if (no_reentrance) return;
-      lcd_wait_for_homing();
-      lcd_goto_screen(_lcd_level_bed_homing_done);
+      if (axis_homed[X_AXIS] && axis_homed[Y_AXIS] && axis_homed[Z_AXIS])
+        lcd_goto_screen(_lcd_level_bed_homing_done);
     }
 
     /**

README.md

 
 ## Recent Changes
 - RCBugFix
+  - Fixed broken MBL
 
 - RC8 - 06 Dec 2016
   - Major performance improvement for Graphical LCDs