Added WaitForUp button block, motors bug fixed and added some small corrections.