Add save machanism
realize by FreeRTOS software timer, when specify idle time pass, turn off motor