Fix changing status UI_MODE_PRINTING when heating

Fix changing status UI_MODE_PRINTING when heating
Fix not stop when heating and waiting for temperature