|
|
@@ -1026,17 +1026,41 @@ uint8_t ctr_clear(uint16_t status_clear)
|
|
|
|
|
|
|
|
|
//路由器供电
|
|
|
+static rt_timer_t timer_router = RT_NULL;
|
|
|
+
|
|
|
+static void router_timeout_callback(void *parameter)
|
|
|
+{
|
|
|
+ LOG_W("路由器定时恢复供电");
|
|
|
+ ctr_router(ON);
|
|
|
+}
|
|
|
+
|
|
|
void ctr_router(uint8_t status_router)
|
|
|
{
|
|
|
rt_pin_mode(ROUTER, PIN_MODE_OUTPUT);
|
|
|
|
|
|
- //rt_pin_mode(POWER_CLEAR, PIN_MODE_OUTPUT);
|
|
|
if(status_router==ON)
|
|
|
{
|
|
|
+ /* 关闭可能存在的定时器 */
|
|
|
+ if (timer_router != RT_NULL) {
|
|
|
+ rt_timer_stop(timer_router);
|
|
|
+ }
|
|
|
rt_pin_write(ROUTER,ON);
|
|
|
}
|
|
|
else {
|
|
|
rt_pin_write(ROUTER,OFF);
|
|
|
+ /* 创建单次定时器(30分钟),超时后自动恢复供电 */
|
|
|
+ if (timer_router == RT_NULL) {
|
|
|
+ timer_router = rt_timer_create("t_router", router_timeout_callback,
|
|
|
+ RT_NULL, 60 * 60 * RT_TICK_PER_SECOND,
|
|
|
+ RT_TIMER_FLAG_ONE_SHOT | RT_TIMER_FLAG_HARD_TIMER);
|
|
|
+ if (timer_router == RT_NULL) {
|
|
|
+ LOG_E("timer_router create failed!");
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ } else {
|
|
|
+ rt_timer_stop(timer_router);
|
|
|
+ }
|
|
|
+ rt_timer_start(timer_router);
|
|
|
}
|
|
|
}
|
|
|
//清扫-推杆电机
|
|
|
@@ -2042,13 +2066,13 @@ static void Work_Loop_thread_entry(void *parameter)
|
|
|
Uart5_Write_Bin(motor1_Forword, sizeof(motor1_Forword)); //推杆打开
|
|
|
rt_thread_delay(20000);
|
|
|
Uart5_Write_Bin(motor2_Forword, sizeof(motor2_Forword)); //震动
|
|
|
- ctr_Collect_Fan(ON)
|
|
|
+ ctr_Collect_Fan(ON);
|
|
|
for(uint8_t i = 0; i < 30; i++){
|
|
|
rt_thread_delay(1000);
|
|
|
LOG_I("等待震动完成:%d",i);
|
|
|
}
|
|
|
Uart5_Write_Bin(motor2_Stop, sizeof(motor2_Stop)); //关闭震动
|
|
|
- ctr_Collect_Fan(OFF)
|
|
|
+ ctr_Collect_Fan(OFF);
|
|
|
rt_thread_delay(2000);
|
|
|
Uart5_Write_Bin(motor1_Backward, sizeof(motor1_Backward)); //推杆关闭
|
|
|
rt_thread_delay(1000);
|