Fixed bug in mode 1-2, finish mode 3