|
|
@@ -192,13 +192,16 @@ int selfcheck(uint8_t type)
|
|
|
/********************************************************/
|
|
|
//打开上仓门
|
|
|
ctr_cangmen_up(OPEN);
|
|
|
+ rt_thread_delay(1000);
|
|
|
for(int i = 0;i<5;i++)
|
|
|
{
|
|
|
current_i[i] = atoi(device_status.power);
|
|
|
rt_thread_delay(1000);
|
|
|
}
|
|
|
ctr_cangmen_up(OFF);
|
|
|
+ rt_thread_delay(1000);
|
|
|
current_open = calculate_average(current_i,5);
|
|
|
+ LOG_W("上仓门action电流:%d",current_open);
|
|
|
if(current_open-current_>100)
|
|
|
{
|
|
|
HMI_WRITE("selfcheck.t9.bco=2024");
|
|
|
@@ -214,13 +217,16 @@ int selfcheck(uint8_t type)
|
|
|
/********************************************************/
|
|
|
//打开下仓门
|
|
|
ctr_cangmen_down(OPEN);
|
|
|
+ rt_thread_delay(1000);
|
|
|
for(int i = 0;i<5;i++)
|
|
|
{
|
|
|
current_i[i] = atoi(device_status.power);
|
|
|
rt_thread_delay(1000);
|
|
|
}
|
|
|
ctr_cangmen_down(OFF);
|
|
|
+ rt_thread_delay(1000);
|
|
|
current_open = calculate_average(current_i,5);
|
|
|
+ LOG_W("下仓门action电流:%d",current_open);
|
|
|
if(current_open-current_>100)
|
|
|
{
|
|
|
HMI_WRITE("selfcheck.t10.bco=2024");
|
|
|
@@ -296,8 +302,9 @@ int selfcheck(uint8_t type)
|
|
|
rt_thread_delay(1000);
|
|
|
}
|
|
|
current_open = calculate_average(current_i,5);
|
|
|
+ LOG_W("清扫action电流:%d@%d",current_open,current_);
|
|
|
rt_thread_delay(1000);
|
|
|
- if(current_open-current_>120)
|
|
|
+ if(current_open-current_>=100)
|
|
|
{
|
|
|
HMI_WRITE("selfcheck.t11.bco=2024");
|
|
|
device_status.C01 &= ~(1<<10);
|