Вам же уже 100500 раз сказали, дальше свою логику начните прикручивать, не зацикливайтесь только на состоянии оси и двигателя. И у вас все просыпется к чертям...