|
|
@@ -2545,7 +2545,8 @@ void slidelock()
|
|
|
//限位开关判断函数
|
|
|
void turnlimit(void)
|
|
|
{
|
|
|
- Motor_shake(ON,0);
|
|
|
+ //Motor_shake(ON,0);
|
|
|
+ Motor_Qingsao_R_PWM(ON);
|
|
|
static uint16_t turn_timeout = 0;
|
|
|
|
|
|
rt_pin_mode(LIMIT_DOWN,PIN_MODE_INPUT);
|
|
|
@@ -2558,7 +2559,7 @@ void turnlimit(void)
|
|
|
//ctr_cangmen_down(CLOSE);
|
|
|
rt_thread_delay(50);
|
|
|
turn_timeout++;
|
|
|
- if(turn_timeout==100){
|
|
|
+ if(turn_timeout==200){
|
|
|
char *translate = makeJson_Warn("translate","limit timeout");
|
|
|
DTU_Write("%s",translate);
|
|
|
rt_free(translate);
|
|
|
@@ -2574,7 +2575,7 @@ void turnlimit(void)
|
|
|
{
|
|
|
turn_timeout++;
|
|
|
rt_thread_delay(5);
|
|
|
- if(turn_timeout==1000){
|
|
|
+ if(turn_timeout==2000){
|
|
|
char *translate = makeJson_Warn("translate","limit timeout");
|
|
|
DTU_Write("%s",translate);
|
|
|
rt_free(translate);
|
|
|
@@ -2589,15 +2590,16 @@ void turnlimit(void)
|
|
|
rt_thread_delay(20);
|
|
|
if(rt_pin_read(LIMIT_DOWN)==0)
|
|
|
{
|
|
|
- Motor_shake(OFF,0);
|
|
|
+ //Motor_shake(OFF,0);
|
|
|
+ Motor_Qingsao_R_PWM(OFF);
|
|
|
break;
|
|
|
}
|
|
|
else {
|
|
|
break;
|
|
|
}
|
|
|
}
|
|
|
- Motor_shake(OFF,0);
|
|
|
-
|
|
|
+ //Motor_shake(OFF,0);
|
|
|
+ Motor_Qingsao_R_PWM(OFF);
|
|
|
turn_timeout = 0;
|
|
|
char *translate = makeJson_Warn("translate","done");
|
|
|
DTU_Write("%s",translate);
|