Some tweaks for manual bed levelling by menu

Change-Id: Ibdea80be36d981c5b6a6161cabda816ac05d62d8